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Preface 


r 


This  thesis  set  out  to  demonstrate  that  a microprocessor  could 
be  used  as  the  central  element  in  the  autopilot  for  the  XBQM-106  Mini- 
RPV.  In  addition  to  fulfilling  this  goal,  we  have  shown  that  the 
autopilot  can  be  constructed  at  ultra-low  cost,  a primary  factor  in 
the  XBQM-106  program.  Also,  for  the  first  time  three  important  tasks 
have  been  accomplished:  the  data  pertinent  to  this  subject  has  been 
brought  together  in  one  place,  a thorough  literature  search  of  the 
subject  area  has  been  made,  and  a complete  control  analysis  of  the 
factors  relevant  to  the  control  of  the  XBQM-106  has  been  made.  In 
short,  a solid  framework  has  been  laid  for  follow-on  development  of 
a flight-capable  autopilot  and  the  incorporation  of  additional  features 
into  it. 

We  wish  to  thank  the  personnel  of  Flight  Dynamics  Laboratory's 
Mini-RPV  Group  for  suggesting  this  project,  providing  the  majority  of 
the  basic  data  needed,  and  giving  freely  of  their  time  to  assist  in 
innumerable  ways.  We  also  would  like  to  thank  Dr.  Gary  B.  Lamont  for 
his  overall  guidance  and  encouragement.  Finally,  special  thanks  must 
go  to  Mr.  Keith  Jones  of  the  ASD  Computer  Center  Hybrid  Simulation 
Branch.  Without  his  help,  verification  of  our  results  would  have  been 
impossible. 
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Mnemonic 

Ao 

VSND 

Speed  of  sound,  ft/sec 

ay 

AY 

Lateral  acceleration,  ft/sec2 

b 

SPAN 

Wing  span,  ft 

C 

CHORD 

Mean  aerodynamic  chord,  ft 

C1 

— 

Generalized  autopilot  rate  gain 

c2 
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s 

— 

Laplace  operator 

S 

AREA 

Wing  area,  ft2 

T 

max 

TMAX 

Maximum  thrust,  lbs 

— 

THRST 

Calculated  cruise  thrust,  lbs 

u 

— 

Forward  perturbation  velocity,  ft/sec 

U 

— 

Forward  velocity,  ft/sec 

V,  VT 

VFPS 

Total  velocity,  ft/sec 

ZT 

ZT 

Thrust  line  offset,  ft 

a 

AOA 

Angle  of  attack,  deg 

B r 

— 

Sidesl ip  angle,  deg 

GAMMA 

Flight  path  angle,  deg 

eT 

EPSTH 

Thrust  line  inclination  with  respect  to  oody 
X-axis,  deg 
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Symbol 

Mnemon i c 

6 

a 

DA 

6,,  _ 6 
aL  3d 

Aileron  deflection,  = 1—  , deg 

6e 

DE 

Elevator  deflection,  deg 

6 

r 

DR 

Rudder  deflection,  deg 

C 

ZETA 

Damping  ratio 

e 

TH 

Pitch  attitude,  deg 

6c 

THCMD 

Pitch  attitude  command,  deg 

• 

9 

THDOT 

Pitch  rate,  deg/sec 

PHI 

Roll  attitude,  deg 

♦ 

PHCMD 

Roll  attitude  command,  deg 

4> 

PHI  DOT 

Roll  rate,  deg/sec 

*« 

PSDCMD 

Yaw  rate  command,  deg 

* 

PSI 

Yaw  attitude,  deg 

PS  1 DOT 

Yaw  rate,  deg/sec 

p 

DEN 

Mass  density  of  air,  slugs/ft3 

ti) 

n 

— 

Undamped  natural  frequency,  rad/sec 

T 

r 

— 

Yaw  rate  washout  time  constant,  sec 

Aero  Coefficients  (Ref  31) 

cd 

MIN 

CL  „ 
a=0 

C, 

MIN 

CDMIN 

CL(A0A=0) 

CL(CDMIN) 

Minimum  drag  coefficient  (C^  versus  C^  curve) 

Lift  coefficient  at  a=0 

Lift  coefficient  at  C (C.  versus  CD  curve) 

UMIN 

cL 

lmax 

Cm  t 
a=0 

CLMAX 

CM (A0A=0) 

Maximum  lift  coefficient  (C^  versus  C^  curve) 

Pitching  moment  coefficient  at  a=0 

2 

KCL2 

Curve  fit  constant  (C.  versus  C_  curve) 
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Symbol 


Mnemonic 

KDE2 

DEMIN 


Curve  fit  constant  (drag  polar),  1/deg2 
Elevator  deflection  at  Cn  , deg 


Stability  Derivatives  (Ref  29 ; 30; 3 1 ) 

Cn  CDM  Change  of  drag  with  mach,  1/rad 

UM 

CD^  CDO  Trim  drag  coefficient,  1/rad 

C-  CDA  Change  of  drag  with  angle  of  attack,  1/deg 

ua 

C_*  CDAD  Change  of  drag  with  rate  of  angle  of  attack, 

a 1/rad 

C CDDE  Change  of  drag  with  elevator  deflection,  1/deg 

X 

Cp  CDQ  Change  of  drag  with  pitch  rate,  1/rad 

q 

C CLQ  Change  of  lift  with  pitch  rate,  1/rad 

Lq 

C CLO  Trim  lift  coefficient,  1/rad 

L0 

C.  CLM  Change  of  lift  with  mach,  1/rad 

LM 

C CLA  Change  of  lift  with  angle  of  attack,  1/deg 


Change  of  lift  with  rate  of  angle  of  attack, 
1/rad 


Change  of  lift  with  elevator  deflection,  1/deg 
Change  of  rolling  moment  with  roll  rate,  1/rad 
Change  of  rolling  moment  with  yaw  rate,  1/rad 


CDM 

C|>0 

CDO 

CDA 

V 

CDAD 

a 

\ 

CDDE 

\ 

CDQ 

\ 

CLQ 

\ 

CLO 

X 

CLM 

X 

CLA 

X 

CLAD 

a 

\ 

CLDE 

X 

CLP 

C'r  , 

CLR 

Cl„ 

CLB 

Change  of  rolling  moment  with  sideslip  angle, 
1/deg 


Symbol 

Hnemon i c 

C,B 

CLBD 

Change  of  rolling  moment  with  sideslip  angular 
rate,  1/rad 

Cl6 

a 

CLDA 

Change  of  rolling  moment  with  aileron  deflec- 
tion, 1/deg 

C, 

,<Sr 

CLDR 

Change  of  rolling  moment  with  rudder  deflection, 
1/deg 

C 

mq 

CMQ 

Change  of  pitching  moment  with  pitch  rate,  1/rad 

CmM 

CMM 

Change  of  pitching  moment  with  mach,  1/rad 

C 

ma 

CMA 

Change  of  pitching  moment  with  angle  of  attack, 
1/deg 

C . 
ma 

CMAD 

Change  of  pitching  moment  with  angular  rate  of 
attack,  1/rad 

C 

m « 

6e 

CMDE(AOA) 

Change  of  pitching  moment  with  elevator  deflec- 
tion, 1/deg 

C 

"p 

CNP 

Change  of  yawing  moment  with  roll  rate,  1/rad 

c 

nr 

CNR 

Change  of  yawing  moment  with  yaw  rate,  1/rad 

S 

CNB 

Change  of  yawing  moment  with  sideslip  angle, 
1/deg 

c . 

"e 

CNBD 

Change  of  yawing  moment  with  sideslip  angular 
rate,  1/rad 

S 

a 

CNDA 

Change  of  yawing  moment  with  aileron  deflection, 
1/deg 

C 

"6r 

CNDR 

Change  of  yawing  moment  with  rudder  deflection, 
1/deg 

C 

yP 

CYP 

Change  of  sideforce  with  roll  rate,  1/rad 

• 

• 

c 

Yr 

CYR 

Change  of  sideforce  with  yaw  rate,  1/rad 

XX 


Mnemonic 


C . CYBD 


c 

Y6 

a 

CYDA 

C 

CYDR 

Change  of  sideforce  with  sideslip  angle,  1/deg 


Change  of  sideforce  with  sideslip  angular  rate, 
1/rad 

Change  of  sideforce  with  aileron  deflection, 
1/deg 

Change  of  sideforce  with  rudder  deflection, 
1/deg 
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Abstract 

V 

The  development  of  a digital  autopilot  for  the  XBQM-106  Mini- 
Remotely  Piloted  Vehicle  (RPV)  is  described.  The  design  is  based  on 
the  RCA  CDP-1802  microprocessor  with  ultra-low  component  cost  as  a 
primary  goal.  The  digital  autopilot  is  developed  through  the  bread- 
board stage,  and  performance  testing  is  accomplished  via  hybrid  simu- 
lation. First,  aircraft  transfer  functions  are  derived  from  aerody- 
namic wind  tunnel  data.  Then  a complete  control  analysis  is  made  of 
the  existing  analog  autopilot,  sensors,  actuators,  and  aircraft  dyna- 
mics. This  is  followed  by  synthesis  of  the  digital  algorithms  (includ- 
ing a digital  filter)  by  means  of  digitization.  Hardware  is  selected 
based  on  system  requirements,  and  hardware  design  details  are  included. 
Software  to  execute  the  digital  algorithms  is  developed  and  described. 
The  results  of  testing  by  hybrid  simulation  show  that  the  performance 
of  the  digital  autopilot  is  comparable  to  the  existing  analog  auto- 
pilot. Finally,  recommendations  for  the  follow-on  study  are  included. 
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MICROPROCESSOR-BASED  DIGITAL  AUTOPILOT 
DEVELOPMENT  FOR  THE  XBQM-106  MINI-RPV 

I . Introduction 

The  past  few  years  have  brought  about  rapid  advances  in  the  fie'd 
of  microprocessor  technology  and  applications.  Impressive  economies 
associated  with  this  technology  can  be  achieved  and  include  such  bene- 
fits as  increased  performance,  flexibility,  reliability,  maintainability, 
modularity,  density,  and  decreased  component  costs.  For  control  appli- 
cations, digital  processing  circuits  demonstrate  far  less  drift  with 
respect  to  such  factors  as  temperature,  voltage,  age,  etc.,  than  analog 
circuits,  and  result  in  very  precise  repeatability  from  unit  to  unit. 

The  microprocessor  and  its  constituent  analog/digital  circuitry  is  now 
the  vogue  in  design  engineering  (Ref  6;45). 

Statement  of  Problem 

The  Mini-RPV  (Remotely-Piloted  Vehicle)  Group  of  the  Air  Force 
Flight  Dynamics  Laboratory  (AFFDL)  at  Wr ight-Patterson  AFB  suggested 
that  an  investigation  be  conducted  into  the  feasibility  of  designing  a 
prototype  digital  autopilot  (A/P)  for  the  XBQM-106  Mini-RPV.  The  A/P 
should  be  microprocessor-based,  emulate  the  already  existing  KBG  Corp- 
oration analog  A/P,  and  be  designed  with  ultra-low  component  cost  in 
mind.  ? Performance  of  the  digital  A/P  should  be  compared  to  that  of  the 
analog  A/P  which  has  been  modelled  on  the  Comcor/Sigma  7 Hybrid  Simula- 
tor at  the  WPAFB  Computer  Facility.  Actual  flight  testing  of  the  re- 
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on  study. 

After  evaluating  the  nature  of  the  problem,  it  was  determined  that 
the  analog  A/P  and  its  associated  control  loop  characteristics  had  been 
developed  by  indirect  "hand-tweaking"  of  gains  based  on  simulation  and 
flight  testing.  No  conventional  control  loop  analysis  had  been  accom- 
plished to  validate  the  aircraft  and  A/P  performance.  In  addition, 
concrete  performance  characteristics  had  not  been  established. 

Because  of  this  added  aspect,  a complete  conventional  control 
analysis  of  the  various  loops  is  needed  to  verify  the  already  estab- 
lished loop  gains  and  to  provide  a vehicle  for  further  performance 
evaluations.  Providing  this  analysis  will  greatly  enhance  the  under- 
standing of  the  RPV  and  A/P  dynamics. 

Approach 

Evaluation  of  the  recommended  proposal,  stated  in  a letter  from 
the  Mini-RPV  Group,  yields  a basic  framework  for  the  development  of 
this  study. 

Chapter  II  develops  the  necessary  linear  system  model  transfer 
functions  for  the  RPV,  sensors  and  actuators.  These  dynamic  character- 
istics are  evaluated  from  a frequency  standpoint  for  possible  inclusion 
into  linear  control  loop  models  representative  of  the  3~axis  analog  - 
A/P.  Chapter  II  references  Appendix  A which  contains  an  extensive  air- 
craft transfer  function  derivation  section.  For  documentation  purposes, 
time  responses,  frequency  responses,  and  root  loci  are  included  for 
these  functions.  In  addition,  a summary  of  simulated  free  RPV  time  re- 
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sponses  are  attached  for  comparative  purposes.  The  results  of  this 
chapter  provide  the  additional  framework  for  control  analysis  in  Chap- 
ter III. 

Chapter  III  describes  the  analog  A/P  and  its  functional  character- 
istics. Based  upon  the  constraints  imposed  by  this  system,  a 3-axis 
control  loop  model  is  generated  for  the  analysis.  Transfer  functions 
are  incorporated  from  Chapter  II.  Since  the  primary  purpose  of  this 
chapter  is  to  develop  a reliable  linear  system  model  of  the  A/P  suitable 
for  control  analysis,  the  measure  of  accuracy  or  validity  is  determined 
by  comparing  the  time  responses  of  the  model  A/P,  axis  to  axis,  with 
the  simulated  analog  A/P.  Similar  forcing  functions  are  assumed.  In 
order  to  manipulate  the  model  to  produce  these  similar  qualitative  re- 
sults, the  actual  feedback  gains  employed  in  the  analog  A/P  are  used 
directly  in  the  linear  model.  No  attempt  is  made  to  optimize  loop  per- 
formance by  "gain-tweaking"  or  compensation.  Root  locus  and  time  re- 
sponse techniques  are  used  in  the  analysis.  A spin-off  of  this  analysis 
yields  recommendations  for  improved  A/P  performance. 

In  Chapter  IV  the  control  loops  of  the  analog  A/P  are  digitized 
and  digital  feedback  controllers  established.  The  important  factors 
associated  with  digital  control  are  investigated.  These  include:  word 
length,  sampling  frequency,  transport  delay  and  numerical  errors.  The 
analog  high-pass  filter  in  the  yaw  rate  loop  is  converted,  via  the 
Tustin  transformation,  into  a digital  filter  represented  as  a linear 
difference  equation.  Once  the  digital  A/P  model  is  developed,  the  next 
two  chapters  proceed  with  the  digital  A/P  hardware  and  software  design. 


Consistent  with  the  already  established  digitization  scheme, 

Chapter  V describes  the  actual  digital  A/P  hardware  design  to  include 
microprocessor  and  component  selection,  system  build-up,  functional 
breadboarding  of  the  circuitry  and  troubleshooting.  Schematics  illus- 
trate in  detail  the  progressive  A/P  mechanization. 

Chapter  VI  develops  the  required  digital  control  software  and 
operating  system  for  A/P  operation.  One  axis  at  a time  is  considered, 
tested,  then  incorporated  into  the  main  software  program.  The  final 
product  consists  of  an  interleaved,  interrupt-oriented  3-axis  control 
algorithm  with  digital  filtering  requiring  approximately  650  ei^t-bit 
bytes  of  memory.  Flow  charting,  testing,  and  evaluations  are  included 
for  support. 

To  graphically  demonstrate  the  comparative  performance  character- 
istics of  the  analog  and  digital  A/P's,  Chapter  VII  analyzes  the  results 
of  time  response  testing  via  hybrid  simulation.  Qualitative  examination 
reveals  very  close  agreement  both  in  the  transient  and  steady  state. 
Sources  of  errors  are  discussed.  In  addition,  time  response  histories 
versus  sampling  frequency  for  the  digital  A/P  show  progressive  perform- 
ance degradation  for  decreasing  frequencies.  A feasible  range  of  sam- 
pling frequencies  is  thus  established. 


Chapter  VIII  discusses  potential  areas  of  improvement  in  the  analog 
A/P.  Recommendations  include  stating  specific  A/P  performance  criteria. 


re-evaluating  the  dynamic  characteristics  of  the  RPV  actuators  because 
of  their  overly  restrictive  nature,  and  investigating  the  inclusion  of 
feedback  compensation  in  the  control  loops  to  enhance  performance.  Rec- 


ommendations for  the  digital  A/P  include  a follow-on  study  incorporating 
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additional  A/P  modes  (altitude  hold,  heading  hold),  actual  flight 
testing,  and  finally  investigating  the  feasibility  of  using  the  new 
RCA  1804  microprocessor  in  a more  compact  flight-testable  version 
of  the  current  system.  Final  remarks  conclude  this  study  and  provide 
the  motivation  for  its  future  continuance. 

Literature  Search 

A thorough  literature  search  indicates  this  investigation  to  be 
the  only  current  DOD  study  of  its  type  germane  to  Mini-RPV's.  Only 
one  other  study,  sponsored  by  Melpar  Corporation,  centers  on  this  sub- 
ject, but  their  results,  based  on  the  Fairchild  F-8  microprocessor, 
are  sketchy  and  proprietary  (Ref  33).  A list  of  digital  A/P  studies 
particularly  relevant  to  this  investigation  include: 

— Northrop  Ventura  (MQM-74C)  digital  drone  based  upon  the 
sixteen-bit  Tl  9900  microprocessor;  proprietary;  most 
useful;  dated  15  Jan  1978  (Ref  6;45) 

—Numerous  missile  digital  A/P's  from  1973  to  present; 

technology  old;  control  analysis  still  valid  (Ref  2 ; 20 ; 26) 

— Teledyne  Ryan  (M-262)  Navy  Mini-RPV  with  combination  analog/ 
digital  control  system;  informative,  non-technical ; tech- 
nology old;  dated  24  Oct  1975  (Ref  46) 

These  few  references  contain  the  most  up-to-date  information  avail- 
able on  specific  applications  of  microprocessor-based  digital  flight 
control/A/P's  to  drones,  missiles  and  Mini-RPV's.  Since  the  interest 
generated  in  this  field  appears  to  be  mushrooming,  this  study  provides 
a "bench  mark"  for  further  Mini-RPV  digital  A/P  tjevelopments. 
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In  order  to  easily  understand  and  evaluate  a particular  system, 
it  must  be  modelled  in  a manner  which  is  both  mathematically  tractable 
and  accurate.  This  model  representation  must  approximate  closely  the 
"real  world"  non-linear  system.  With  this  in  mind,  this  chapter  pro- 
ceeds to  model  the  RPV,  sensors,  actuators,  and  3-axis  A/P  in  a manner 
suitable  for  conventional  linear  control  analysis.  The  definition  of 
A/P  includes  all  sensors,  actuators,  and  control  loops  needed  to  accom- 
plish desired  aircraft  stabilization.  RPV  system  model  1 ing  includes 
the  following: 

general  aircraft  description 

general  A/P  model 

RPV  transfer  function  derivation 

--sensor  and  actuator  characteristics 
complete  system  model 

General  Description 

The  XBQM-106  aircraft,  as  depicted  in  fig.  2-1,  is  a lightweight 

propeller-driven  vehicle termed  a Mini-RPV  (miniature  remotely- pi  lotdd 

vehicle).  This  specific  nomenclature  is  adopted  from  weight  and  size 

parameters  described  in  the  AFFDL  document  RPV  Flying  Qualities  Design 

Cr i ter ia  (Ref  41 ) . Primary  usage  of  this  vehicle  is: 

- — a technology  demonstrator  (test  bed  for  testing  mission 
profiles  and  equipment) 

--enemy  harassment  in  hostile  environment  (flown  either  under 
drone  program  control  or  as  a manually  controlled  data- 
1 inked  RPV) 
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General  aircraft  characteristics  include: 

— maximum  weight  - 200  pounds  loaded 
—wing  span  - 10  feet 
—fuselage  length  - 10  feet 
— engine  - 10  HP  McCulloch 
— service  ceiling  - 10,000  feet  (approx.) 

Additional  aircraft  parameters  may  be  found  in  (Ref  29 ; 39) • 

For  RPV  flight  orientation  a fixed  axis  system  convention  is  used 
throughout  and  is  described  by  Euler  angles  (eg.  0,  <f>,  \l>)  expressed  in 
degrees  (see  fig.  2-2)  (Ref  32:208).  Since  control  surface  deflection 
terminology  (eg.  6e,  6a,  6f)  also  plays  an  important  role  in  the  under- 
standing of  time  responses,  fig.  2-3  is  included  as  a visual  aid. 
Conventions  are  as  follows  for  positive  sense: 

6e  : Elevator  deflection;  trailing  edge  down  (TED)  -*•  positive 

6 : Aileron  deflection;  6_  = (6,  - 6,  )/2 

a a aL  aR 

where 

6ai  : Lefthand  aileron  deflection;  TED  -*■  positive 
al 

6g  : Righthand  aileron  deflection;  TED  -*■  positive 
R 

6r  : Rudder  deflection;  trailing  edge  left  -*■  positive 
Autopilot  Description 

Two  types  of  flying  analog  A/P's  are  in  existence,  one  manufactured 
by  General  Dynamics  (Pomona)  and  the  other  developed  by  KBG  Corporation 
(in-house  avionics  contractor.  Mini -RPV  Group,  AFFDL,  WPAFB).  This 
study  will  concern  itself  only  with  the  latter  A/P  since  the  General 
Dynamics  unit  was  designed  for  use  with  a specific  target  seeker  (Ref  29). 
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Figure  2-2:  Fixed  Axis  Conventions  (Positive  Sense) 


The  detailed  schematics  for  the  analog  A/P  are  illustrated  in  (Ref  29) 
and  need  not  be  presented  here.  More  relevant,  however,  is  the  general- 
ized A/P  block  diagram  in  fig.  2-4. 

At  present,  the  analog  A/P  is  flown  in  two  distinct  modes:  manual 
ground  control  and  free-f light  stabilizer. 

As  shown  in  fig.  2-4,  manual  pulse-width  modulated  (PWM)  ground 
control  commands  direct  the  aircraft  to  a desired  flight  attitude. 

With  the  A/P  engaged,  this  "fly-through"  capability  allows  for  improved 
stability.  Data-1 inked  commands  are  mixed  with  analog  A/P  outputs  in 
a pulse-width/analog  mixer  (essentially  a summing  junction),  and  then 
directed,  in  PWM  form,  to  the  various  control  surface  actuators. 

In  the  absence  of  any  ground  commands,  the  A/P  functions  as  a wing- 
levelling 3~axis  stabilizer.  Disturbances  such  as  gusts  or  down-drafts 
are  sensed  by  the  A/P,  which  in  turn  reacts  to  return  the  aircraft  to 
its  original  attitude.  This  mode  is  very  important  for  free-flight 
cruise  operation. 

Note  that  those  items  starred  (*)  in  the  diagram  are  future  opera- 
tional modes  and  are  not  presently  incorporated  into  the  A/P. 

A generalized  3-axis  analog  A/P  model  is  depicted  in  fig.  2-5,  and 
represents  the  actual  analog  A/P  control  system.  This  design  is  con- 
ventional and  noted  in  several  references  (Ref  4;  17;  32).  The  model 
takes  into  consideration  the  following  set  of  important  system  constraints: 

— All  loop  gains  are  expressed  as  constants  in  the  feedback 
paths  only.  There  are  no  feed-forward  gains. 

--Rate  and  attitude  loop  controllers  are  placed  in  the  feed- 
back paths  only. 

— The  yaw  damper  includes  rate  and  lateral  acceleration  feed- 
back. 
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Figure  2-5:  General  Analog  Autopilot  Model 


—The  flying  A/P  has  a pulse-width/analog  mixer  depicted 
in  f ig.  2-A.  The  PWM  scheme  can  be  approximated  as  a 
continuous  system  (i.e.  unity  gain)  and  neglected  from 
further  consideration  (Ref  20). 

As  shown  in  f ig.  2-5,  the  A/P  stabilizes  the  three  independent 
axes  of  pitch,  roll  and  yaw.  Both  pitch  and  roll  have  rate  and  atti- 
tude feedback  whereas  yaw  has  rate  and  lateral  acceleration  feedback. 
Sensors  on  the  RPV  detect  such  parameters  as  angular  rate,  attitude, 
and  acceleration,  and  feed  these  signals  into  respective  loop  control- 
lers. The  controller  outputs  are  then  summed  with  data-1 inked  commands, 
if  any,  and  then  routed  to  the  control  surface  actuators.  Thus,  closed- 
loop  negative  feedback  stabilization  is  accomplished  (Ref  29). 

Now  that  a conceptual  model  is  described,  it  is  necessary  to  de- 
termine the  respective  Laplace  transfer  functions  for  the  RPV,  sensors 
and  actuators.  These  are  required  "building-blocks"  for  further  analysis. 

Aircraft  Transfer  Functions 

The  first  major  requirement  to  model  a control  system  similar  to 
fig.  2-5  is  to  ascertain  the  necessary  aircraft  transfer  functions. 

Since  these  were  not  available,  they  had  to  be  derived.  Using  current 
aerodynamic  wind  tunnel  dati  (Ref  39)  and  an  interactive  computer  pro- 
gram (Ref  30;3l),  called  the  McGlynn  program,  linearized  transfer  func- 
tions for  all  three  axes  were  determined  for  three  specific  flight 
regimes  (see  Appendix  A for  detailed  derivation  and  listings). 


Altitude  (ft,  msl*) Weight  (lbs) Mach 


Ease  1 

1000 

135 

.125 

Case  1 1 

3000 

135 

.125 

Case  III 

6000 

135 

.125 

*Mean  Sea  Level 
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These  three  cases  were  chosen  to  investigate  the  sensitivity  of  the 
transfer  function  coefficients  to  changes  in  altitude  while  keeping 
weight  and  mach  constant.  A visual  inspection  of  these  functions  re- 
veals an  insignificant  change  in  the  coefficient  values.  Such  small 
deviations  indicate  relative  stability  of  the  functions  with  respect 
to  altitude  changes.  As  such,  the  prospect  of  having  to  employ  "gain 
scheduling"  when  designing  the  A/P  for  all  RPV  operating  altitudes  is 
negated.  Based  upon  this  brief  analysis,  the  transfer  functions  as- 
sociated with  Case  It  are  chosen  for  use  throughout  the  rest  of  the 
study.  Time-responses,  frequency  responses,  and  root  loci  for  all 
Case  II  functions  are  included  in  Appendix  A.  In  addition.  Appendix 
A contains  hybrid  simulation  f ree-ai rf rame  RPV  time  responses  to  forc- 
ing functions  nearly  identical  to  those  used  in  producing  the  transfer 


function  time  responses.  In  doing  so,  a direct  means  of  comparison  is 
made  of  the  resultant  waveforms.  Very  close  agreement  exists  between 
transient  and  steady-state  responses.  This  qualitative  analysis  provides 
a good  measure  of  confidence  to  the  modelling  process,  but  is  not  an 
overriding  issue  at  this  point  in  the  analysis. 

Since  aircraft  dynamics  are  non-linear  in  nature,  linear  transfer 
function  theory  makes  the  following  assumptions  (Ref  *»:21;30:5): 

— aircraft  is  rigid 

— earth  is  the  inertial  reference  frame 

—atmosphere  is  stationary  or  translating  at  a constant 
velocity  relative  to  the  earth 

--vehicle  mass,  inertia,  and  angular  momentum  due  to 
spinning  rotors  are  constant 
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— vehicular  motion  consists  of  small  disturbances 
(perturbations)  about  a reference  steady-state 
flight  condition  (equilibrium) 

— airflow  is  quasi-steady 

The  resulting  linear  equations  are  more  tractable  than  their  non-linear 
counterparts,  and  do  not  unduly  restrict  the  control  analysis.  Strict 
adherence  to  control  surface  deflection  and  angle  notation  is  maintained 
to  provide  continuity.  Once  the  RPV  transfer  functions  are  established, 
sensors  and  actuators  must  be  modelled. 

Sensor  and  Actuator  Characteristics 


In  order  to  model  the  complete  control  system,  the  individual  com- 
ponent sensor  and  actuator  dynamics  must  be  known  or  estimated.  As 
mentioned  earlier,  the  current  A/P  consists  of  a vertical  gyro  (pitch/ 
roll  attitude),  fluidic  rate  sensors  (pitch/roll/yaw  rates),  an  option- 
al lateral  accelerometer  (yaw  turn  coordination),  and  actuators.  Be- 
cause these  devices  are  low-cost  and  not  of  MIL-SPEC  quality,  little 
is  known  or  published  about  actual  dynamics.  As  a result,  it  was  neces- 
sary to  derive  or  approximate  each  component  transfer  function.  The 
rate  sensors  and  actuators  required  laboratory  testing  to  determine  their 
frequency  characteristics.  The  lateral  accelerometer  (pendulum)  trans- 
fer function  was  stated  erroneously  by  the  laboratory,  but  subsequent 
review  corrected  the  mistake.  The  vertical  gyro  dynamics  were  specified 
in  the  literature  (Ref  51).  The  following  discussion  provides  an  in- 
depth  analysis  and  documentation  of  device  dynamics  and  pertinent  char- 

• I 

acteristics  from  which  individual  component  models  are  extracted  for  use 
in  the  overall  control  model. 
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Vertical  Gyro.  The  most  critical  and  expensive  ($2400)  sensor  is 
the  commercially  available  Humphrey  vertical  gyro  (VG34-0201-1 ) (Ref  51). 
It  provides  accurate  pitch  and  roll  attitude  orientation  for  the  air- 
craft. Compared  to  the  aircraft  natural  frequencies,  the  gyro  dynamics 
are  sufficiently  high  to  be  modelled  as  a pure  gain  of  unity.  Justifi- 
cation for  this  assumption  is  based  upon  the  fact  that  the  erection  system 
natural  frequency  (cone)  must  be  much  less  than  the  aircraft  longitudinal 
phugoid  natural  frequency  (u)np)  (Ref  42:10.25).  Specification  data  in- 
dicates a nominal  erection  rate  of  9 deg/min  which  in  turn  equates  to 

to  ^ = .0026  rad/sec. 
ne 

(9  deg/min) (1  min/60  sec)(l  rad/57.3  deg)  = .0026  rad/sec 

Since  u)np  = .33  rad/sec  for  the  current  flight  condition,  the  above 
assumption  is  valid. 


Vertical  gyro  characteristics  include  (Ref  51): 
- — roll  displacement  (<}>)  ± 90  deg  (±  1 deg) 
pitch  displacement  (6)  ± 60  deg  (±  1 deg) 


1 ineari ty 

—normal  erection  rate 


-drift 


± 1%  full  scale 

9 deg/min  (±  3 deg/min) 

1 deg/min  max.  after  6 min  of 
3 deg  reverse 


Vertical  gyro  sensitivities  include  (Ref  29) 


pitch  attitude 

--roll  attitude 


± 2.5  volts/±  60  deg  = .04167  volts/deg 
± 2.5  lts/±  90  deg  = .02778  volts/deg 


4 


t 


Note:  Because  this  device  is  so  much  more  expensive  than  the  other  sen- 
sors, a comparable  performance  substitute  is  being  sought  by  the  labora- 
tory. 


Rate  Sensors.  A low-cost  ($250)  independent  3-axis  fluidic  rate 
sensor  has  been  developed  in  the  laboratory  especially  for  RPV  A/P  appli- 
cations. The  device  exhibits  simple  construction  and  excellent  perform- 
ance (Ref  29 ; 39) - Device  dynamics  were  approximated  by  recording  a rise 
time  of  **5  msec  to  a unit  step  input.  The  transfer  function  can  be 
modelled  as  a first  order  lag  with  a cutoff  frequency  (u^)  of  50  rad/sec 
as  given  by  (Ref  29 ; 39) s 


<-sr> + ’ 


50 

s + 50 


(2-1) 


The  cutoff  frequency  is  derived  from  the  definition  of  rise  time,  which 
is  the  time  required  for  the  response  to  a unit  step  function  input  to 
rise  from  10  to  90  percent  of  its  final  value  (Ref  18:183).  Assume  a 
normalized  first  order  lag  response  to  a unit  step,  as  a function  of  the 
time  constant  T and  time  t,  to  be  expressed  as  (Ref  32:59)s 


1 - e 


(2-2) 


By  letting  .045  seconds  represent  the  90  percent  point,  as  illustrated 
in  fig.  2-6,  manipulation  of  Eq  (2-2)  yields  a time  constant  of  about 


Normalized  First-Order  Lag  Response-Rate  Sensor 


t = 2.303T 

Since  .0^5  sec  represents  2.303T,  the  time  for  one  T is  found  by  the 
expression: 

♦ 0^5  sec  _ X 
2.303  T " T 

Solving  for  X yields  .0195  seconds.  Since  cutoff  frequency  (rad/ 
sec)  is  the  inverse  of  the  time  constant  (sec),  inverting  .0195  sec 
yields  51.3  rad/sec  (approximately  50  rad/sec). 

Because  the  dynamics  of  the  rate  sensor  exceed  that  of  the  aircraft 
longitudinal  short-period  by  a factor  of  nearly  seven  (50  rad/sec  vs.  7 
rad/sec),  the  sensor  can  be  neglected  in  the  control  analysis  and  incor- 
porated in  the  rate  loop  as  a unity  gain. 

Rate  sensor  characteristics  include  (Ref  29 ; 39) : 

—good  sensitivity  range  (maximun)  0 to  i 100  deg/sec 

— noise  0.002  volts  RMS 

— excellent  linearity  ± 0.25% 

—small  size  88  mm  X 88  mm  X 63  mm 

--low  power  consumption  3 watts  at  28  VDC 

—power  required  1 3~28  VDC 

—3  independent  axes  (pitch,  roll, 
yaw)  in  one  package 

— no  hysterisis 
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—no  dead  band 


—good  frequency  response 

Rate  sensor  sensitivities  include  (Ref  29 ; 39 ) t 

All  3 axes:  (±  2.5  volts/±  50  deg/sec)  = .05  volts/deg/sec 


Pendulum  Accelerometer.  For  coordinated  turning  performance  a com- 
mercially available,  low-cost  ($100)  pendulum  accelerometer  is  employed 
in  the  yaw  axis.  A feedback  signal  proportional  to  lateral  acceleration 
in  the  y-direction  is  produced.  Because  the  aircraft  will  eventually  be 
flown  in  an  uncoordinated  yaw-to-turn  mode,  with  wings  level,  this  de- 
vice will  most  likely  be  excluded  from  the  A/P.  For  documentation  pur- 


poses only  its  characteristics  are  included. 

Specification  sheet  data  reveals  the  Humphrey  (CPI 7-0601-3)  pendulum 

to  be  highly  accurate  and  long-lived  with  a natural  frequency  (oj  ) of 

pa 

20.1  rad/sec  (3.2  HZ)  (Ref  38).  Assuming  first  order  lag  dynamics,  the 
transfer  function  is  modelled  as: 


Note:  this  transfer  function  had  been  erroneously  entered  as  ■ in 

(Ref  29). 

Characteristics  include: 

—accuracy  ± 1%  full  scale 

— resolution  less  than  .2° 
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— 1 inear i ty 
— output  range 


within  . 5 % 


Note  that  the  output  in  degrees  is  proportional,  not  to  sideslip  angle, 
but  to  angular  acceleration  (ay)  in  ft/sec2. 

Device  sensitivity  is: 


± 2.5  V 
±*5° 


= .0556  volts/deg 


± 45  “ ± 1 g E i 32.2  ft/sec2 


so  in  an  alternative  form. 


± 2.5  V 
± 32.2  ft/sec* 


.0776 


volts 


Actuator.  Several  commercial  actuators  were  investigated  for  possible 
use  in  the  aircraft.  Based  upon  ruggedness,  high  speed,  high  torque  char- 
acteristics, and  especially  low  cost  ($39),  the  Futaba  FP-S14  actuator 
was  finally  chosen.  Identical  actuators  are  employed  for  deflection  of 
primary  flight  control  surfaces:  elevator,  aileron,  rudder  (Ref  29 ; 39) • 
Each  actuator  is  controlled  by  pulse-width  modulated  signals  in  the 
range  of  650  ysec  ~ 1900  ysec,  5 VDC  nominal  amplitude,  with  maximum 
torque  of  13  kg-cm.  Internal  characteristics  dictate  a slew  rate  limit- 
ation ;On  rotary  angle  of  ± 45°  in  .5  sec.  at  5 VDC.  This  implies  a 
maximum  stop-to-stop  actuator  speed  of  approximately  90-100  deg/sec  of 


unrestricted  deflection  (Ref  44) 


r 


Since  manufacturer  device  dynamic  data  was  non-existent,  laboratory 
frequency  response  testing  was  initiated  on  the  actuator  using  an  avail- 
able phase-angle  voltmeter  connected  to  an  x-y  sweep  plotter.  Various 
plots  were  recorded  as  a function  of  load.  The  most  representative  case 
is  depicted  in  fig.  2-7  with  a load  of  5.5  in-lb  and  a maximum  servo 
output  arm  deflection  of  ± 20°.  Overall  results  indicate  that  the  actu- 
ator is  essentially  linear  up  to  and  including  ± 20  degrees  of  deflection 
at  varying  loads.  Non-linear  behavior  is  exhibited  for  larger  deflec- 
tions. Control  analysis  must  be  restricted  to  this  linear  range. 

By  assuming  second-order  characteristics  of  fig.  2-7,  a cutoff  fre- 
quency (ton  ) is  estimated  to  be  2.5  HZ  (15.7  rad/sec)  at  the  -90°  phase 

d 

point.  Subsequent  magnitude  and  phase  plot  curve  fitting  through  the 
use  of  TOTAL  (Ref  28)  yields  the  following  actuator  dynamics: 


6(S) 

6“[sT 


where 


. OS3  ."7 

V,  w_ 


246.5 


S2  + 25.12S  + 246.5 


a 


a 


(2-4) 


6(S)  = control  surface  deflection  (deg) 

6c(S)=  control  surface  command  (deg) 

con  = natural  cutoff  frequency  (rad/sec) 
a 

£ = damping  ratio 


Fig.  2-8  exhibits  the  linear  frequency  response  of  the  actuator  from 
Eq  (2-4).  Actuator  dynamics  are  sufficiently  close  to  those  of  the  basic 
aircraft  to  warrant  inclusion  in  the  control  analysis  model.  Note,  how- 
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Figure  2-8:  Model  of  Actuator  Frequency  Response 
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ever,  that  the  actuator  poles  are  complex  conjugates;  this  will  later 
be  shown  to  impose  constraints  on  the  root-locus  stability  analysis. 

Actuator  rate  limitation:  ± 1*5  deg/sec 

Control  surface  deflection  angle  limitations  (mechanical): 

6g  (elevator)  ± 8 deg 

6_  (aileron)  + 14  deg  (TEU)* 

a 

- 11  deg  (TED)* 

6r  (rudder)  ± 16  deg 

* TEU  (trailing  edge  up) 

TED  (trai  1 ing  down) 

Complete  System  Model 

Once  the  transfer  functions  for  the  aircraft,  sensors,  and  actua- 
tors have  been  modelled  and  determined  to  be  relevant  to  the  control 
analysis,  the  analog  A/P  loop  analysis  can  proceed.  Chapter  III  models 
and  analyzes  the  pitch,  roll,  and  yaw  axes  independently  and  compares 
results  with  hybrid  simulations.  The  qualitative  analysis  of  the  model 
with  the  simulation  lends  credence  to  modelling  accuracy. 
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III.  System  Analysis 

Having  established  the  transfer  functions  for  the  components  of 
the  general  A/P  model  (fig.  2-5,  Chapter  II),  linear  control  analysis 
of  each  individual  axis  proceeds.  The  primary  means  of  determining 
whether  or  not  the  model  of  the  A/P  performs  like  the  analog  A/P  is 
through  a qualitative  comparison  of  transient  responses  generated 
by  each  axis  of  the  A/P  to  the  same  input  forcing  function.  Time 
responses  for  the  model  A/P  are  obtained  from  the  computer  program 
TOTAL  (Ref  28)  whereas  those  from  the  analog  A/P  result  from  the  al- 
ready existing  hybrid  simulation. 

The  key  point  of  this  comparison  process  lies  in  the  need  to 
directly  substitute  the  analog  A/P  loop  gains,  obtained  by  indirect 
"hand-tweaking"  methods  (Ref  29)  into  the  feedback  loop  gains  of  the 
model  A/P.  In  order  to  do  this,  the  analog  gains  require  manipulation 
so  as  to  be  compatible  with  the  model  gain  structure.  Appendix  B 
addresses  the  gain  manipulation.  It  is  important  to  stress  that  the 
model  A/P  performance  is  not  to  be  optimized  in  any  sense  because  this 
will  negate  the  whole  purpose  of  this  comparative  approach.  Extensive 
use  of  the  computer-aided-design  program  TOTAL  (Ref  28)  is  employed 
throughout  the  analysis  for  generation  of  root  loci,  frequency  responses 
and  time  responses. 

Longitudinal  Controller 

Based  upon  previous  aerodynamic  and  simulation  studies  conducted 
by  the  Mini-RPV  Group,  the  need  to  stabilize  the  longitudinal  axis  of 
the  aircraft,  when  not  operating  under  remote  control,  has  been  con- 
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firmed  (Ref  29).  Two  dominant  dynamic  characteristics  govern  longi- 
tudinal stability  for  most  subsonic  aircraft:  the  "phugoid",  and 


"short-period"  oscillations  (Ref  *4:35).  The  "phugoid"  or  long-period" 
mode  is  generally  more  oscillatory  (relatively  undamped)  in  nature  and 
of  low  natural  frequency  (u)p).  It  consists  primarily  of  variations  in 
pitch  attitude  (9),  and  forward  velocity  (U)  with  angle  of  attack  (a) 
nearly  constant.  The  "short-period"  mode,  on  the  other  hand,  is  con- 
siderably more  damped  and  of  higher  natural  frequency  (u>sp) . Variations 
occur  in  a and  0,  but  with  very  little  change  in  U (Ref  4:35).  If  the 
reader  wishes  to  vary  these  modes,  refer  to  Appendix  A,  fig.  A-la  ~ 

A-3b.  A pilot  flying  an  aircraft  can  usually  control  the  "phugoid", 
but  the  "short-period"  is  much  faster,  and  is  often  responsible  for 
"pilot-induced-oscillations"  (P10)  (Ref  42).  Since  the  RPV  must  have 
the  capability  to  fly  without  remote  pilot  control,  both  modes  are  in- 
cluded in  the  transfer  functions  for  analysis. 

This  section  first  develops  and  analyzes  the  pitch  rate  controller, 
then  develops  the  pitch  attitude  controller. 


Linear  Pitch  Rate  Controller.  Control  of  pitch  rate  is  provided 

by  the  linear  rate  controller  shown  in  fig.  3“1.  Pitch  rate  is  detected 

by  the  rate  sensor  which  is  modelled  as  a unity  gain  transfer  function 

(see  chapter  II).  The  signal  is  then  multiplied  by  a suitable  feedback 

gain  ( Kq , KPR) , fed  back  to  a summer  and  subtracted  from  the  pitch  rate 

command  (0  ) . The  resulting  error  signal  (6e  ) then  drives  the  elevator 
c c 

actuator  to  the  desired  deflection  angle  (6e).  Thus,  pitch  rate  damping 
(control)  is  accomplished.  In  the  absence  of  a pitch  rate  command,  rate 
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Block  Diagram  of  Linear  Pitch  Rate  Loop  Controller 


perturbations  (e.g.,  gusts)  applied  externally  to  the  aircraft  will  still 
be  controlled  via  the  feedback  loop. 


This  study  assumes  that  coupling  of  roll  and  yaw  into  the  pitch  axis 
and  vice  versa  is  negligible  (Ref  4). 

The  analysis  begins  by  multiplying  the  actuator  and  RPV  transfer 
functions  together  to  obtain  the  open-loop  transfer  function  (OLTF): 


e (s) 

ec 


(14809. 47) (S) (S+0.090) (S+3.204) 

($‘+0.0575+0. 109) (S"+6.584S+49.545) (S^+25. 125S+246.5)  (3-1) 


Since  the  sign  of  the  RPV  transfer  function  is  negative,  the  sign  of  the 
actuator  transfer  function  is  also  made  negative  to  make  the  overall 
sign  of  Eq  (3-1)  positive.  This  is  a standard  method  in  pitch  axis  an- 
alysis (Ref  4:58).  The  resultant  root  loci  for  Eq  (3-1)  are  shown  in 
figs.  3“2a,b.  Fig.  3~2a  illustrates  actuator  and  "short-period"  branch- 
ing, whereas  fig.  3“2b  shows  "phugoid"  branching.  If  one  were  to  compare 
these  loci  with  those  for  the  basic  RPV  plant  with  no  actuators  (i.e., 
ideal  actuators)  (see  figs.  3~3a,b),  the  subtle  degrading  effects  of  the 
actuators  are  evidenced.  Suffice  it  to  say  that  the  range  of  gains  avail- 
able for  improved  damping  and  stability  performance  are  severely  restrict- 
ed, not  so  much  for  the  "phugoid",  but  primarily  for  the  "short-period". 

Figs.  3~2a,b  also  show  the  roots  of  the  closed-loop  transfer  func- 
tion for  the  feedback  gain  (K*  = .075)  calculated  in  Appendix  B.  As 

0 

stated  earlier,  K'  comes  directly  from  the  analog  A/P  gains  and  is  re- 
quired  for  analysis.  Using  Eq  (3“1)  and  Kg,  the  inner  loop  is  closed  to 
produce  the  closed-loop  transfer  function  (CLTF)  by  the  expression: 

28 


l 


Figure  3-2a:  Root  Locus  of  Linear  Pitch  Rate  Controller 


PITCH  RATE  ROOT  LOCUS  ( KPR=. 075: PHUDO ID  ) 

J»»  0.(0 
<=0.42  : 


Figure  3“2b:  Root  Locus  of  Linear  Pitch  Rate  Controller;  Phugoid 
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OLTF 

1 + OLTF  (Kq) 


This  results  in  the  control  ratio 


e (s)  . 
Sc(s) 


(s+0»°9°)  (S+3.20M(S) 

(s^+0. 0635+0.08*0  (S  +9. 423S+ 125.081 ) (S^+22.275S+126.29)  (3-2) 
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This  is  a stable  system  since  no  roots  lie  in  the  right-half  plane 
(Ref  15).  The  closed-loop  pitch  rate  system  does  not,  however,  improve 
the  system  significantly.  A comparison  of  the  time  responses  and  fig- 
ures of  merit  (see  Table  3_1)  for  the  open-loop  (0(S)/6e  (S);  fig.  3-^a.b) 

• • 

versus  closed-loop  (0(S)/0  (S);  fig.  3“5a,b)  system  demonstrates  marginal 

c 

improvement.  In  particular,  peak  time  (T  ) decreases  by  16.6%,  settling 
time  (Ts)  decreases  by  13.2%,  and  peak  value  (Py)  decreases  by  21%.  A 
very  close  look  at  the  root  locus  structure  tells  why  these  improvements 
may  be  the  best  attainable  by  gain  variations  alone.  Better  results 
would  have  been  expected.  Also  note  that  the  steady-state  responses  to 
the  unit  step  go  to  zero.  This  is  because  of  the  S in  the  numerator  of 
Eq  (3-2)  which  acts  like  a differentiator  (Ref  *t).  A frequency  response 
plot  is  included  for  reference  in  fig.  3~6. 

Verification  of  the  pitch  rate  loop  model  compared  to  the  analog 
A/P  cannot  be  made  at  this  time  because  time  responses  for  the  loop  were 
not  made  via  simulation.  Closing  the  outer  attitude  loop  and  comparing 
recorcted  responses  will,  however,  provide  model  validity. 


Settling  time,  sec 
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Linear  Pitch  Attitude  Controller.  The  linear  pitch  attitude  con- 


troller is  formed  by  closing  the  attitude  (outer)  loop  around  the 
closed  pitch  rate  (inner)  loop  (see  fig.  3-7  for  block  diagram).  Pitch 
attitude  is  detected  by  a vertical  gyro  whose  transfer  function  is  unity 
(see  chapter  ll).  The  signal  is  fed  back,  multiplied  by  a suitable 
feedback  gain  (K^,  KPA)  and  subtracted  from  the  attitude  pitch  command 
(0c>  THCMD).  The  resulting  error  signal  becomes  a pitch  rate  command 
(eg)  to  the  inner  loop. 

Manipulation  of  the  model  yields  the  new  open-loop  transfer  function: 


9 (S)  _ 


( 1 ^8°9 . ^*7 ) (S+0.090)  (S+3.204) 
■40.063S+0.084)  (Si!+9.Z*23S+1 25.081)  (sk+: 


(3-3) 


which  is  a type-0  system.  The  root  loci  for  Eq  (3“3)  are  shown  in  figs. 
3-8a ,b. 

Using  the  necessary  feedback  gain.  Kg  = 0.34,  (derived  in  Appendix 
B) , and  Kg  = 1.0,  the  outer  loop  is  closed  to  form  the  control  ratio: 


9(S)  _ 

els7  " Ts^c 


(14809. 47) (S+0.090) (S+3.204) 


(3-4) 


Inspection  of  the  roots  of  Eq  (3-4)  reveals  a stable  type-0  system. 

Because  of  this,  one  would  expect  a steady-state  error  to  exist  (Ref  15:178) 
Application  of  the  final  value  theorem  to  Eq  (3“4)  using  the  full  equation 
coefficients  from  TOTAL  and  a step  unit,  9c(t)  * RQu_^(t),  yields  (Ref  15: 
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Figure  3~7:  Block  Diagram  of  Linear  Pitch  Attitude  Controller 


Figure  3-8a:  Root  Locus  of  Linear  Pitch  Attitude  Controller 


6(t)  = 1 im  56(S)  = 1.539R 

ss  $ -*■  0 c 


(3-*a) 


Eq  (3_i*a)  clearly  shows  the  expected  steady-state  output  to  be  1.539 
times  larger  than  the  input..  If,  for  example,  a 20  degree  pitch  up  is 
commanded,  the  corresponding  output  attitude  will  be  30.78  degrees. 

This  is  obviously  undesirable  and  attenuation  is  needed.  A solution 
exists,  however,  to  remedy  this  condition.  From  fig.  3-7,  and  iM , 
the  closed-loop  transfer  function  is 


e(s)  = Kq  f G (S)  1 

e^TsT  ec  + G(S)K0J 


(3-5) 


where  G (S)  = Eq  (3-3) . 

Taking  the  final  value  of  Eq  (3“5),  for  an  arbitrary  step  input, 

®c ( 1 ) = R0u-i » yields 

ess(t)  - II.  sk6c  f «-5M  \ *.  »-6) 


Thus,  in  order  for  output  attitude  to  equal  input  attitude,  0gs ( t)  = Rq 

9 , then 
c 


Vw-0-65 


(3-7) 


This  substantiates  the  assumption  of  needing  an  attenuator  to  eliminate 
the  steady-state  error. 
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At  this  point,  a frequency  response  for  Eq  (3-5)*  with  K.  =1, 

8c 

is  shown  in  fig.  3“9a.  Inspection  of  the  magnitude  plot  reveals  a hump 

prior  to  rolloff.  This  indicates  second-order  dynamics  which,  in  turn, 

implies  the  possible  existence  of  a time-response  overshoot  peak.  If 

this  fact  is  true,  then  the  degree/magnitude  of  overshoot  is  crucial 

to  the  attitude  controller  response.  If  given  a 20  degree  pitch  up 

command,  the  RPV  may  stall  as  it  pitches  up  greater  than  20  degrees. 

As  a result,  the  peak  value  figure  of  merit  calculated  by  TOTAL 

for  Eq  (3-4) , assuming  K = 1 and  a unit  step,  is 

ec 

Pv  = 2.55821  (3-8) 

Letting  Eq  (3-8)  represent  the  new  interim  final  value  for  any  step 

input,  R u (t),  and  K.  ? 1,  yields 
o-i  6c 

0c<;(t)  = 2.55821  K R (3-9) 

5 ec  o 

Requiring  0 (t)  = R =6-  and  solving  Eq  (3~9)  for  Kfl  produces 

ss  o c °c 

Kec  = 13552 Ts  °*391  (3-10) 

A frequency  response  of  Eq  (3-4)  with  K-  = 0.391  is  shown  in  fig. 

Hc 

3-9b.  Controller  bandwidth  is  approximately  12  rad/sec  (1.9  HZ). 

Time  responses  of  Eq  (3"4)  with  K * 0.39  for  a 20  degree  pitch  up 

°c 

command  (9c  = 20  deg)  are  depicted  in  figs.  3“10a,b.  Note  that  the 
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Figure  3"10b:  Time  Response  of  Linear  Pitch  Attitude  Controller; 
150  sec  ; K0  = 0.39 
c 
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commanded  20  deg  attitude  is  achieved  at  peak  with  a resultant  12  degree 
steady-state  attitude.  These  results,  aiong  with  the  figures  of  merit 
in  table  3“1.  confirm  the  theoretical  model  development. 
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The  time  response  exhibited  in  fig.  3“10a,b  b>a  "standard"  pitch 
attitude  controller  response  and  is  well  documented  (Ref  4 : 79) • Subject 
to  an  input  step  command,  the  RPV  pitches  to  the  commanded  attitude, 
then  slowly  glides/descends  to  a lower  steady-state  attitude.  Pitch 
attitude  controllers  alone  cannot  correct  this  aerodynamic  property. 

Some  form  of  additional  velocity  control  is  needed  to  obtain  the  commanded 
steady-state  attitude  (Ref  4 : 79) - 

Having  designed  a linear  pitch  attitude  controller  model,  the  next 

step  is  to  compare  it  with  the  analog  controller  simulation.  Fig.  3“11 

illustrates  analog  controller  responses  to  the  same  20  degree  pitch  up 

command  (0C)  forcing  function  used  in  the  model.  In  order  to  reproduce, 

as  closely  as  possible,  the  model  response  shown  in  fig.  3“10a,  the  gain, 

Kq  , on  the  analog  controller  simulation,  was  adjusted  to  0.3**-  This 
c 

represents  an  error  of  only  12%.  Figures  of  merit  (see  table  3~ 1 ) show 
a good  deal  of  similarity  between  the  two  responses  (similar  Tp,  Tp,  Tp, 

Py,  Fy)  and  provide  a modest  amount  of  confidence  in  the  modelling  process. 
Thus,  it  is  shown  clearly,  and  within  an  acceptable  margin  of  lineariza- 
tion error,  that  the  analog  pitch  attitude  controller  can  be  modelled 
accurately  with  linear  controller. 


Recommendations.  Without  going  into  detail,  the  root  loci  for  both 
the  pitch  rate  and  pitch  attitude  loops  reveal  that  system  performance 
may  not  be  further  improved  by  loop  gain  variations  alone.  If  improved 
performance  is  required,  the  current  complex-pole  actuators  may  have  to 
be  replaced  with  ones  of  higher  frequency  dynamics  and  real  poles,  or 
lead  compensation  placed  in  the  feedback  loops.  This  will  enable  larger 
loop  gains  which,  in  turn,  means  greater  controller  bandwidth  (i.e., 

BW  > 1.9  HZ)  and  "muscle  power". 


t 

i 


Latera 1 -Pi rect ional  Controllers 

The  usefulness  of  investigating  feedback  loops  closed  around  the 
various  RPV  transfer  functions  is  exactly  the  same  in  the  case  of  lateral 
motions  as  it  is  for  longitudinal.  This  section  will  develop  the  con- 
trollers for  both  the  roll  and  yaw  axes  that  have  been  illustrated  in 
fig.  2-5,  chapter  II.  Again,  as  in  the  longitudinal  case,  it  is  suffi- 
cient to  consider  each  controller  as  a simple  gain  which  has  already  been 
determined  (see  Appendix  B) . 

Typically,  three  dynamic  characteristics  govern  lateral-directional 

flight:  spiral  divergence,  roll  subsidence  and  Dutch  roll  (Ref  32:459). 

Spiral  divergence  motion  consists  of  a combination  of  increase  in  yaw 

angle  and  roll  angle  with  resulting  high  speed  spiral  dive.  The  time 

constant  is  usually  very  large;  15^  = 812  sec  for  Case  II.  Since  the  RPV 

exhibits  "slight"  divergence,  i.e.,  pole  is  in  right  half  plane  (S=. 001231), 

the  purpose  of  using  an  A/P  is  to  impose  a higher  degree  of  stability  to 

this  mode.  Roll  subsidence,  on  the  other  hand,  is  the  rolling  response 

of  the  aircraft  to  an  aileron  input  and  is  described  for  Case  II  as  having 

a time  constant  equal  to  .116  sec  (xD  = .116  sec  for  S = -8.6).  Dutch 

KS 

roll,  primarily  excited  by  the  rudder  (Ref  4:132),  consists  of  both  roll 
and  yaw  angle  excursions.  It  is  usually  lightly  damped  (£  = .266, 
oon  = 48.1  rad/sec  for  Case  II)  and  may  become  objectionable.  There  is  a 
need  to  control  this  mode  through  yaw  rate  damping  (Ref  29).  Rudder  de- 
flections primarily  excite  the  Dutch  roll  mode,  whereas  those  for  the 
aileron  excite  roll  rate  and  roll  angle  with  some  Dutch  roll  superimposed 
in  this  motion  (Ref  4:138). 
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Linear  Roll  Rate  Controller.  The  fundamental  block  diagram  for  the 
linear  roll  rate  controller  is  shown  in  fig.  3“12.  Control  of  roll  rate 
is  provided  for  by  feeding  back  roll  rate  detected  by  a unity  gain  rate 
sensor,  multiplying  the  signal  by  a gain  (K£,  KRR)  and  subtracting  it 
from  the  roll  rate  command  ($c) . The  error  signal  thus  produced  drives 
the  aileron  actuator  to  the  required  position.  Transient  and  steady- 

state  characteristics  are  determined  by  the  feedback  gain  (K*). 

<P 

From  Appendix  A the  RPV  transfer  function  (also  shown  in  fig.  3“12), 
relating  roll  rate  ($)  to  aileron  deflection  (6  ) is  found  to  be: 

a 


(S)  = (112.5) (Sz+2. 477S+22. 169) (S) 

jtT  (S-.001)  (S+8.606)  (S"+2.559S+23.iW) 


(3-11) 


When  Eq  (3H1)is  multiplied  by  the  aileron  actuator  transfer  function,  the 
open-loop  transfer  function  becomes 


J(S)  _ (27730)  (Sz+2. 477S+22. 169)  (S) 

T = (S-.001)  (S+8.606)  (Si!+2.559S+23.146)  (S2+25. 12S+246.5)  (3-12) 

ac 


which  is  a type-0  system.  The  root  locus  of  Eq  (3“12),  depicted  in  fig. 
3~13a,  shows  that  the  linear  roll  rate  controller  system  is  completely 
unstable  for  all  values  of  gain.  This  is  primarily  attributed  to  the 
spiral  divergence  root  (S  = .001)  in  Eq  ( 3“ 1 2 ) which  lies  in  the  right- 
half  plane.  Also  note  that  the  Dutch  roll  mode  is  almost  eliminated  due 
to  the  numerator  zeros  cancelling  the  denominator  poles.  Thus,  and  as 
expected,  roll  rate  inputs  do  not  excite  Dutch  roll  oscillations.  In 
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Figure  3“ 12:  Block  Diagram  of  Linear  Roll  Rate  Controller 


addition  to  the  "slightly"  unstable  spiral  mode,  the  complex  actuator 

poles  (see  fig.  3“13a)  further  degrade  the  controller  root  locus  for 

variations  of  gain.  A comparison  of  this  locus  with  that  of  the  basic 
• 

4>(S)/6a(S)  plant  ( see  fig. 3*1 3b) , without  an  actuator,  clearly  shows 
the  difference.  At  first  glance,  this  discussion  of  degrading  an  al- 
ready unstable  system  seems  meaningless.  However,  when  the  outer  at- 
titude loop  is  closed,  in  the  next  section,  this  rationale  will  prove 
noteworthy. 

The  closed-loop  transfer  function  for  K*  = 0.116  (extracted  from 

<P 

Appendix  B)  is 


i (s) 
*c(s) 


( S— . 0005) 


(27730) (S) (SZ+2.477S+22.171) 

(S+23.71*))  (Sz+2.55i»S+22.A6l)  (S^+10.012S+226.030)  (3-13) 


which  is  a type-0  system.  Fig.  3“13a  indicates  the  pole  locations  of 
Eq  (3-13)  for  a damping  ratio  of  0.33  (C  = .33).  Note  that  Eq  (3“13) 
also  represents  an  unstable  system  due  to  the  spiral  divergence  term 
(S  = .0005).  The  corresponding  time  constant  is  very  large  (33  min). 

Thus,  this  system  can  be  said  to  exhibit  a "slight  long-term"  instabil- 
ity characteristic  which  presents  no  problem  to  the  control  analysis 
system  handling  qualities.  A roll  rate  frequency  response  is  included 
in  fig.  3*1^  to  show  a system  bandwidth  of  about  30  rad/sec  (*».77  HZ). 

Since  no  hybrid  simulation  for  roll  rate  was  recorded,  a comparison 
of  th$  model  with  the  analog  rate  controller  is  not  addressed.  It  is 
appropriate,  however,  to  show  the  degrading  effects  upon  performance  that 
closing  the  roll  rate  loop  produces;  particularly  interesting  is  decreased 

^9 
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damping  and  increased  peak  magnitude.  Compare  fig.  3“15a  (closed  roll 
rate  loop)  with  fig.  3-15b  (open  roll  rate  loop)  for  a unit  pulse  of 
unit  width.  Fig.  3“l6  is  also  included  to  illustrate  the  response  of 
Eq  (3~ 1 3)  to  a unit  step. 

Linear  Roll  Attitude  Controller.  The  linear  roll  attitude  con- 
troller is  formed  by  closing  a position  loop  around  the  closed-loop 
roll  rate  controller  (see  block  diagram  fig.  3~ 1 7) • The  roll  rate  inner 
loop  determines  the  open-loop  poles  of  the  attitude  controller.  Again, 
the  feedback  gain  (K.,  KRA)  is  calculated  in  Appendix  B from  the  analog 


A/P.  Outer  loop  operation  is  similar  to  that  described  in  the  longi- 
tudinal controller  section. 

By  integrating  Eq  (3~1 3)  (i.e.,  deleting  the  numerator  S)  the  open- 
loop  transfer  function  becomes: 


<b (S)  _ (27730)  (Sz+2.477S+22. 171)  

eTsT  (S-.0005)  (S+23.718)  (S"+2. 55^+22. A61 ) (Sz+10.012S+226.030)  (3-H*) 

<P 


The  root  locus  for  this  type-0  function  is  depicted  in  fig.  3“ 1 8 . 

By  incorporating  the  gains,  = 0.267  and  = 1.0,  calculated  in 
Appendix  B,  into  the  analysis  and  closing  the  outer  loop,  the  closed  loop 
transfer  function  becomes 


<t>(S)  (27730)  (Sz+2.477S+22. 171)  

^TsT  ' (s+1.556)  (S+23.11)  (S‘+2.58S+22.376MS‘+9.03bS+Z03./M)  (3-15) 


The  poles  of  this  equation  for  the  damping  ratio,  0.31,  (C  ■ 0.31),  appear 
in  fig.  3-18  and  are  shown  to  be  stable  (i.e.,  no  roots  in  right  half- 
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Figure  3“ 16:  Time  Response  of  Linear  Roll  Rate  Controller;  Unit  Step 


r 


r 


ff 


plane).  For  an  arbitrary  step  input,  4>c(t)  = RQu_^(t),  and  = 1.0, 
the  final  value  of  Eq  (3-15),  as  determined  by  TOTAL,  becomes 


4>ss(t)  = lim  S<J>  ( S) 

s 0 


3.750  R 


(3-15a) 


In  order  for  the  steady-state  output  attitude  to  equal  the  input  attitude 


command  of  20  degrees,  the  value  of  (see  fig.  3-17)  was  reduced  to 


0.267.  This  is  a similar  procedure  to  the  development  used  in  the  pitch 
attitude  control ler„  Note  that  the  frequency  response  (see  fig.  3~19a) 


of  Eq  (3-15)  for  =1.0  does  not  indicate  any  dominant  second-order 


characteristics  which  might  warrant  re-establishing  a new  final  value. 
Fig.  3“19b  exhibits  the  roll  attitude  controller  frequency  response  for 
= 0.267.  System  bandwidth  is  reduced  to  approximately  2 rad/sec 
(0.32  HZ). 

The  time  response  corresponding  to  <t>c  = 20  degrees  is  shown  in  fig. 
3-20.  Figures  of  merit,  calculated  by  TOTAL,  are  shown  in  table  3-2. 

Having  established  a linear  roll  attitude  controller  and  a repres- 
entative time  response  suitable  for  comparison,  the  next  step  involves 
simulation  testing.  As  in  the  pitch  controller  simulation,  the  roll 
attitude  responses  to  a 20  degree  input  step  command  (<)>c)  were  recorded 


for  various  KA  . In  order  to  generate  a similar  analog  controller  atti1 

TC 


tude  simulation,  Kx  was  tuned  to  exactly  0.267,  the  same  value  used  in 
the  model.  The  hybrid  simulation  response  is  shown  in  fig.  3-21.  Again, 
refer rto  the  comparative  figures  of  merit  listed  in  table  3”2.  Results 
indicate  very  similar  characteristics,  i.e.,  T^  within  2%,  T within  8%, 


Ry  and  Fy  identical . 


J 
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Table  3-2 


Figures  of  Merit: 

Roll  Attitude  Controller 

Fv 

T 

R 

T0 

Tp  T$ 

pv 

1.373 

Very  Large 

Very  Large  2.600 

19.999 

19.999 

Model 

1.4 

Very  Large 

Very  Large  2.4 

20. 

20. 

Simula- 

tion 

(Approx. ) 

Based  upon  comparative  results,  the  model  appears  to  be  highly 
correlated  with  the  analog  simulation. 

Recommendat ions.  The  presence  of  the  actuators  in  the  roll  attitude 
controller  still  degrades  the  system  performance.  Specifically,  loop  gains 
are  restricted  by  the  actuator  pole  loci  to  very  small  values.  This  in- 
hibits the  resultant  controller  bandwidth,  i.e.  0.3  HZ,  which,  in  turn, 
restricts  A/P  authority.  Actuator  replacements  and/or  feedback  compen- 
sation, as  discussed  in  the  longitudinal  section,  may  be  logical  recourses 
to  obtain  better  performance.  At  present,  however,  roll  attitude  con- 
troller performance  is  acceptable. 
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The  primary  purpose  of  a Dutch  roll  damper  is  to  reduce  oscilla- 
tions in  roll  (<)>) , yaw  (\|j)  and  sideslip  (B)  angles  due  to  the  applica- 
tion of  rudder  deflections  (Ref  17:27).  This  coupled  oscillation  is 
generally  referred  to  as  Dutch  Roll  and  as  stated  earlier,  is  excited 
by  the  rudder  (Ref  4).  To  dampen  or  otherwise  minimize  these  undesir- 
able effects,  yaw  rate  feedback  is  employed  to  deflect  the  rudder.  Fig. 

2-5  of  chapter  II  illustrates  the  analog  A/P  model  with  a yaw  damper. 

This  controller  consists  of  a Dutch  roll  damper  with  lateral  accelera- 
tion feedback.  Through  simulation  testing,  the  acceleration  feedback, 
normally  utilized  for  coordination  (Ref  4),  was  found  to  actually  de- 
grade performance.  The  laboratory  agreed  and  decided  to  remove  it  from 
the  analog  A/P.  As  such,  this  analysis  considers  only  the  Dutch  roll 
damper. 

The  basic  Dutch  roll  controller  is  depicted  in  fig.  3“22.  Yaw  rate 
is  detected  by  a rate  sensor,  multiplied  by  a predetermined  gain  (K^,  KYR) , 
passed  through  a washout  (high  pass)  filter  and  then  subtracted  from  the 
yaw  rate  command  signal  (t|>c) . The  generated  error  signal  then  drives 
the  actuator  as  before.  The  washout  filter  produces  an  output  only  during 
transient  periods.  In  effect,  damping  (i.e.,  feedback)  occurs  for  high 
frequencies  only.  The  yaw  rate  signal  goes  to  zero  in  the  steady-state 
(Ref  4:139). 


Following  previous  methods,  the  required  feedback  gain  (K^  * 0.586, KYR) 
comes  from  Appendix  B.  The  RPV  transfer  function  ^(Sj/G^S)  (obtained 
from  Appendix  A),  actuator,  and  washout  filter  are  combined  with  * 1 


to  form  the  open-loop  transfer  function: 

*B(S) 

«r 

c 

(2552)  (S2)  (S+8.418)  (S2+0. 43^+0. 199) 

(S-0.001)  (S+0.422)  (S+0.829)  (S+8.606)  (S‘=+2.559S+23. 1 A6)  (S^+25. 12S+2A6.5) 

(3-16) 

which  is  a type-0  system.  The  root  loci  for  Eq ( 3- 1 6 ) are  shown  in  figs. 
3-23a,b. 

For  the  previously  specified  values  of  K*  and  K:,  the  closed-loop 
transfer  function  is  found  to  be 

j(S)  _ 

*c($) 

(2552)  (S+0.A22) (S+0.829) (S+8.1<18) (S2+0.klk$+0.133)  

(S-0.001) (S+0. 381) (S+8.191) (S+16. 55) (Sz+2.978S+2.55A) (S^+9 . A32S+ 1 30 . AO  1 ) 

(3-17) 

which  reveals  that  the  control  system  of  fig.  3“23  is  unstable.  Again, 
the  spiral  divergence  term  (S  = .001)  dictates  the  "slight"  instability 
behavior  with  a long  time  constant  (t  = 8 1 2 sec).  For  yaw  rate  stab- 
ility, however,  the  higher  frequency  transients  (smaller  time  constants) 
are  of  primary  interest.  This  is  especially  true  since  a high-pass  filter 
is  involved. 

A time  response  of  Eq  (3“10)  for  a selected  -3.3  deg/sec  yaw  rate 
step  command  (i|»c)  is  shown  in  figs.  3“24a,b.  Note  the  unstable  affect 
of  the  spiral  divergence  term  for  t > 2 sec.  Also  note  that  the  transient 
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Figure  3“2i*b:  Time  Response  of  Dutch  Roll  Damper,  1000  Sec 


65 


peak  value  at  t = .25  sec  approaches  -3.3  rad/sec 


t 
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A review  of  the  Dutch  roll  damper  frequency  response  (see  fig.  3“25) 
illustrates  the  required  high-pass  filtering  with  cutoff  frequency  equal 
to  1.5  rad/sec  (.238  HZ).  Also  note  that  the  rolloff  frequency  (w.  = 

16  rad/sec)  limits  system  bandwidth  to  1*1.5  rad/sec  (2.31  HZ).  Generally 
speaking,  the  high-pass  filtering  cutoff  frequency  is  acceptable.  Band 
rolloff,  however,  effectively  restricts  system  performance . in  much  the 
same  manner  as  in  the  pitch  and  roll  attitude  controllers. 

Based  upon  the  brief  time  and  frequency  response  characteristics 
of  the  model,  analog  Dutch  roll  damper  responses  were  recorded  for  the 
desired  -3.3  rad/sec  yaw  rate  command  (see  fig.  3_26) . Of  particular 
concern  is  the  output  waveform  for  yaw  rate  ($) . Comparing  the  model 
with  the  analog  time  responses  yields  some  obvious  discrepancies. 

The  Dutch  roll  mode  contains  the  spiral  divergence  root 

(S  = .001)  in  the  denominator  of  Eq  (3~ 10).  The  model 
time  response  reveals  its  subtle  effects  by  the  steady- 
state  (ramp)  drift  effect  which  occurs  after  2 seconds. 

In  order  to  obtain  a good  simulation  response,  the  roll 
axis  was  coupled  to  the  A/P  and  acted  like  a wing-leveller. 

Little  if  any  rolling  occurred  due  to  the  rudder  input. 

The  gross  effect  of  connecting  the  roll  A/P  to  the  system 
negates  the  spiral  divergence  term  from  the  response.  As 
a result,  there  is  no  drift  (see  fig.  3“26  for  lfi).  Even 
. though  this  discrepancy  exists,  the  controller  comparison 
is  not  inval idated. 
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—Since  yaw  rate  command  gain  (K^  , KPSDC)  in  both  time  re- 

vc 

sponses  is  left  equal  to  unity,  one  would  expect  the  tran- 
sients around  0.50  sec  to  be  similar  in  magnitude.  This 
is  not  the  case,  however. 


The  Dutch  roll  damper  (controller)  analysis  is  somewhat  weak  be- 
cause of  the  problems  mentioned  above,  however,  a general  sense  of  con- 
fidence, qualitatively  speaking,  can  be  exacted.  Of  all  the  axes,  this 
one  generates  the  most  uncertainty. 


Recommendations.  Again  actuator  characteristics  inhibit  loop  gain 
variations  and  overall  performance.  The  high-pass  filter  was  chosen 
for  this  loop  without  benefit  of  control  analysis  to  ascertain  its 
effect  on  performance.  Critical  filter  time-constant  analysis  needs  to 
be  considered. 


A qualitative  conventional  control  analysis  has  been  made  of  all 
three  axes,  comparing  the  model  with  the  analog  controllers.  Based 
upon  these  results,  a fairly  good  measure  of  confidence  in  the  analysis 
has  been  displayed.  The  groundwork  for  further  linear  control  analysis 
is  laid. 


IV.  Digital  Synthesis 


Probably  the  most  important  theoretical  aspect  of  this  study  in- 
volves the  selection  of  an  approach  for  developing  the  digital  A/P. 

In  the  interests  of  simplicity  and  realizability,  a conventional  digiti- 
zation scheme  is  chosen  so  as  to  produce  a digital  A/P  which  performs 
in  a comparable  manner  to  its  analog  counterpart.  As  opposed  to  the 
more  involved  "direct  digital"  design  methods  which  seek  to  optimize 
digital  system  performance,  digitization  merely  converts  the  continuous 
(analog)  system  into  a sampled-data  system  which  can  perform  only  as 
well  as  the  analog  system.  Digitization,  however,  is  much  simpler  to 
analyze  and  implement  (Ref  9).  In  addition  to  establishing  the  basic 
modus  operandi,  this  chapter  discusses  analog  A/P  transformation,  sig- 
nificant control  system  parameters,  and  digital  yaw  rate  washout  filter 
development.  The  results  of  this  chapter  provide  the  underlying  frame- 
work for  the  actual  hardware  and  software  design. 

Digitization  of  an  existing  analog  controller,  like  that  shown  in 
fig.  3~7  of  chapter  III,  yields  the  pitch  axis  digital  controller  exhib- 
ited in  fig.  4-1.  This  study  assumes  that  all  digital  controllers  are 
placed  in  the  feedback  paths  and  incorporate  as  many  loops  as  possible. 
Further,  only  a single  sampling  frequency  is  selected  for  the  A/P;  multi- 
rate sampling  is  not  considered,  even  though  better  performance  over  the 
single-rate  might  be  achieved.  Fig.  4-2,  an  expansion  of  fig.  4-1, 
illustrates  that  sensor  output  signals,  such  as  attitude  and  rate,  are 
selectively  sampled  by  an  analog-to-digi tal  (A/D)  converter,  and  then 
operated  upon  by  the  controller  to  produce  a weighted  sum.  Once  the 
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Figure  4-1:  Block  Diagram  of  Digitized  Pitch  Attitude  Controller 


a 


processing  is  complete,  the  results  are  restored  to  analog  form  via  a 
corresponding  d ig i tal -to-ana log  (D/A)  converter.  The  D/A  is  assumed 
to  contain  a sampler  and  a zero-order  hold  (ZOH).  This  is  then  summed 
with  an  analog  control  input.  The  resulting  error  signal  commands  the 
actuator  to  produce  a control  surface  deflection.  The  digital  con- 
troller modules  shown  in  figs.  4-1,  4-3  and  4-5  perform  the  necessary 
mathematical  operations  to  emulate  the  analog  A/P.  For  pitch  and  roll 
(figs.  4-2,  4-4),  essential  operations  include  gain  multiplication  and 
signal  summing.  For  yaw  (fig.  4-6),  a washout  or  high-pass  filter  is 
implemented  digitally.  As  it  turns  out,  filter  design  becomes  the  over- 
riding issue  which  governs  such  control  parameters  as  word  length,  samp- 

ling  time  and  errors. 

* ' 

The  beauty  of  digital  processing  is  that  each  control  loop  can  be 

organized  into  an  overall  three-axis  A/P  under  direct  control  of  an 
operating  system.  Control  of  signal  acquisition,  computations  and  out- 
put follows  a definite  structure  governed  by  the  required  sampling  fre- 
quency. 

t In  order  to  realize  a digital  controller,  a baseline  analysis  of 

! 

the  digital  control  requirements  is  first  established.  Significant 
parameters  for  this  analysis  include: 

- — sampling  frequency 

word  lengths  (A/D,  D/A,  internal) 

f i Iter  design 

- — other  (transport  delay,  errors,  scaling) 

A brief  discussion  of  each  parameter  develops  the  constraints  placed  on 
the  digital  control  system. 
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Figure  **-3!  Block  Diagram  of  Digitized  Roil  Attitude  Controller 


ze< 


Figure  A-5:  Block  Diagram  of  Digitized  Yaw  Damper 


lematic  of  Digitized  Yaw  Damper 


Sampling  Frequency 

Since  sampling  frequency  plays  such  an  important  role  in  controller 
stability,  proper  determination  of  such  is  essential.  The  Mini-RPV  Group 
indicated  verbally  that  the  RPV  would  not  encounter  in-flight  dynamic 
frequencies  greater  than  5"10  HZ.  Roskam  (Ref42)  also  substantiates  a 
maximum  expected  frequency  of  10  HZ.  Knowing  this  essential  piece  of 
information,  then  Shannon's  (Nyquist's)  Sampling  Criteria  is  applied 
(Ref  27).  This  theorem  states  that  a signal  must  be  sampled  at  a fre- 
quency (fg)  at  least  two  times  the  highest  frequency  (f  ) expected  in 
system  (Ref  27). 


f > 2f 
s — m 


(4-1) 


For  practical  considerations,  one  which  insures  reproducibility,  f is 

chosen  to  be  2-10  times  larger  than  f . Because  f = 10HZ  for  the  RPV, 

3 m m ’ 

then  f must  be  at  least  20  HZ.  As  a first  "guess"  approximation,  f 
s s 

was  chosen  to  be  50  HZ.  This  margin  of  30  HZ  is  not  chosen  without 
reason;  sampling  theory  assumes  reconstructed  data  to  be  represented  by 
infinite  wordlength.  In  the  real  world,  this  is  not  true;  finite  word- 
length  dictates  performance  and  restricts  signal  reconstruction. 


Word  Length 


The  three  primary  areas  in  a digital  system  where  word  length  governs 
cost  and  performance,  include  A/0  and  0/A  converters  plus  internal  pro- 
cessing algorithms  (Ref  20).  Table  4-1  is  a summary  of  sensor  and  actu- 
ator signal  output  ranges,  accuracies,  and  required  A/D  resolution.  Note 
that  resolution  is  assumed  to  be  25%  of  the  accuracy  value  (Ref  20). 
Knowing  the  minimum  resolution  requirements  allows  the  determination  of 
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TABLE  4-1 


A/D  Signal 

1 Conversion 

Requi remen ts 

Device 

Signal  Type 

Operational 

Range 

Accuracy 

. (D 

A/D  Resol utio'n 
(%  of  Range) 

Vert ical 
Gyro 

P i tch 

Attitude  (0) 

+40,-60  deq 

±1.0  deq 

0.25  deg  (.63,-42) 

Rate 

Sensor 

Pitch  . 

Rate  (0) 

±40  deg/sec 

±0.1  deq/sec 

0.025  deg/sec  (.06) 

Vertical 

Gyro 

Roll 

Attitude  (<}>) 

±45  deg 

±1.0  deg 

0.25  deg  (.56) 

Rate 

Sensor 

Roll 

Rate  (0) 

±40  deg/sec 

±0.1  deq/sec 

0.025  deg/sec  (.06) 

Rate 

Sensor 

Yaw 

Rate  (ip) 

±40  deg/sec 

±0. 1 deq/sec 

0.025  deg/sec  (.06) 

Pendulum 

Lateral 

Acceleration 

(ay) 

±45  deg 

±0.2  deg 

0.05  deg  (.11) 

Actuator 

6 

c 

±45  deg 

±0.5  deg 

0.125  deg  (.28) 

(l)  Resolution  requirement  taken  as  25%  of  accuracy  requirement  (Ref  20) 


A/D  Wordlenqth  Requirements 


(2) 


Word  Length  LSB  Resolution  Full  Scale  Resolution 

(Volts) 


8 

.0039063 

.019531 

9 

.0019531 

.009766 

10 

.0009776 

.004883 

11 

.0004883 

.002441 

12 

.0002441 

.001221 

13 

.0001221 

.000610 

14 

.0000610 

.000305 

15 

.0000305 

.000153 

16 

.0000153 

.000076 

(2)  Resolution  = 2 n where  n is  number  of  bits;  sign  bit  is  not  utilized. 
Full  scale  0-5  VDC. 


a minimum  acceptable  A/D  wordlength.  The  bottom  of  Table  4-1  clearly 
shows  that  eight  bits  is  all  that  is  necessary  to  faithfully  reproduce 
system  signals.  Since  minimum  system  cost  prevails,  an  eight-bit  A/D 
converter  is  desirable,  especially  since  the  microprocessor  will  have 
an  eight-bit  wordlength.  As  will  be  shown  in  the  next  chapter,  an  A/D 
with  a conversion  time  (t^)  of  100  psec  is  chosen.  KUO  (Ref  27)  in- 
dicates that  the  A/D  conversion  time  is  related  to  the  maximum  input 
frequency  (f__J  by 


maX  (2TT)(rc)2n"1 


where  n = number  of  bits  in  A/D. 

Substituting  the  values  in  Eq  ?*-2)  yields  f = 12.43  HZ.  This 

max 

provides  good  justification  for  selection  since  the  A/D  will  reproduce 
input  frequencies  up  to  12.43  HZ,  well  within  the  RPV  bandwidth.  If, 
perchance,  higher  RPV  frequencies  are  involved,  a sample  and  hold  device 
will  be  necessary. 

The  RPV  actuator  resolution  requirements  are  also  listed  in  Table 
4-1.  Following  a similar  development  to  the  A/D  case,  only  eight  bits 
are  necessary  for  its  acceptable  D/A  operation. 

Internal  wordlength  processing  requirements  are  satisfied  by  six- 
teen-bit, double  precision,  fixed-point  arithmetic.  This  is  primarily 
a result  of  required  gain  scaling  to  achieve  desired  nominal  accuracy 
for  the  controller.  The  digital  filter,  discussed  in  next  section,  will 
be  shown  to  require  at  least  fifteen  bits.  From  an  experimental  stand- 
point, it  is  found  that  sixteen-bit  wordlength  performed  effectively  in 
the  digital  control  algorithms.  This  insures  a comparable  level  of  per- 
formance. ort 


Digital  Filter 


Generally  speaking,  a digital  filter  is  a linear  shift-invariant 
discrete-time  system  that  is  realized  using  f inite-wordlength  (precision) 
arithmetic  (Ref  37:195).  This  study  involves  converting  the  existing 
analog  yaw  rate  washout  (high-pass  filter)  to  a digital  filter  with  sim- 
ilar performance  characteristics.  Whereas  an  analog  (continuous)  filter 
is  represented  by  a differential  equation,  a digital  filter,  as  in  this 
case,  becomes  a linear  difference  equation.  Numerous  techniques  are 
cited  to  perform  this  transformation  (Ref  2;3;6;9; 10;20;21 ;26;27;28;37) . 


No  method  will  provide  a set  of  difference  equations  which  will  behave 
like  the  continuous  analog  case  in  all  respects.  Ideal  transform  prop- 
erties include  (Ref  *»0:A-7): 

stability  preservation  (assumes  infinite  wordlength) 

filter  cascading  capability 

system  order  retention 

DC  gain  retention 

impulse  response  retention 


A review  of  several  transform  methods  was  made.  Included  were  first- 
difference,  Tustin,  Z-transform,  and  matched  Z-transform.  State-variable 
methods  were  specifically  excluded  from  consideration  based  on  a trade- 
off between  hardware  and  software  requirements.  Based  upon  the  ability 
to  preserve  stability,  cascading,  system  order  and  DC  gain,  the  Tustin 
transformation  was  chosen  to  design  the  digital  filter.  It  is  very 
popular  (Ref  6;l»8)and  easy  to  use,  especially  since  it  exists  as  an  op- 
tion in  TOTAL  (Ref  28). 
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With  this  in  mind,  the  existing  analog  high-pass  filter, 


S2 

S2  + 1.25s  + 0.35 


(4-3) 


of  cutoff  frequency  equal  to  1.40  (ioc  = 1.40  rad/sec),  is  converted  via 
the  bilinear  Tustin  transform. 


S 


2 (Z-1) 
T TTmT 


(4-4) 


where  T = = .02  sec,  to  the  Z-domain  expression, 

s 

(.98762018-1 ,9752404Z~1  +.98762018z~2) 

ta  (Z)  " -1  -2 

(1  - 1.9751712Z  + .97530950Z  ) (4-5) 


Eq(4-5)is  then  converted  to  the  linear  difference  equation: 

Y (k)  = .98762018  X (k)  - 1.9752404  X (k-1 ) + .98762018  Y(k-2)  + 

1.9751712  Y (k)  - .97530950  Y (k-1 ) (4-6) 

Based  upon  an  analysis  of  the  analog  filter  roots,  the  sampling  frequency, 
and  minimum  acceptable  root  error  (assumed  to  be  10%)  in  the  Z-domain 
transfer  function  Eq  (4-5) , a minimum  word  length  of  fifteen  bits  is  re- 
quired to  implement  all  coefficients  in  the  digital  filter  (Ref  20:64). 
This  discovery,  not  unexpected,  then  led  to  the  adoption  of  sixteen-bit, 
double-precision  arithmetic  for  the  filter  algorithm. 

Frequency  responses  for  the  analog  filter  (Fig.  4-7)  compared  to 
digital  filters  (fig.  4-8,  Tustin;  fig.  4-9,  first-difference)  reveal 
almost  no  shift  of  cutoff  frequency  and  no  DC  gain  variation.  Again, 
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Figure  *t-8:  Frequency  Response  of  Digital  Washout  Filter 
(Tustin,  fs  « 50  HZ) 
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these  responses  correspond  essentially  to  infinite  wordlength  (i.e., 
64  bit  for  Cyber  Computer).  Because  sixteen-bit  arithmetic  is  re- 


quired, the  filter  was  implemented  in  software  and  a frequency  response 
generated  to  determine  performance  effects.  The  experimental  results 
are  discussed  in  chapter  VII.  Note,  the  Tustin  transformation  may  re- 
quire that  the  analog  filter  cutoff  frequency  be  "prewarped"  so  as  to 
be  accurately  reproduced  in  the  discrete  domain  (Ref  37).  This  facet 
of  filter  development  is  not  significant  in  this  application.  The 


digital  filter  was  only  designed  for  f = 50  HZ.  If  the  sampling  fre- 
quency needs  to  be  changed,  so  must  the  filter  constants.  Chapter  VI 
will  describe  in  detail  the  software  implementation  of  the  recursive 
high-pass  filter. 


Other 

Although  not  specifically  addressed  in  this  study,  additional  fac- 
tors must  be  considered  in  a digital  control  analysis.  These  include 
(Ref  20): 

studying  the  effects  of  transport  delays  due  to  system 

components  (A/D,  D/A,  etc.)  on  performance 

— -investigating  the  effects  of  bit  truncation  and  rounding 
associated  with  wordlength  (Chapter  VI  briefly  discusses 
the  topic) 

—describing  the  effects  of  a noisy  environment  on  system 
performance;  this  may  dictate  that  signal  "conditioning" 
be  a factor 

- — performing  sensitivity  analysis  to  ascertain  best  or 
desired  performance  (consider  wordlength  and  sampling 

r frequency) 

This  chapter  establishes  the  basic  control  theory  philosophy  and 


parameters  needed  to  continue  with  the  digital  A/P  mechanization  in  hard- 


V.  Digital  Mechanization 

Fig.  5-1  is  a diagram  of  the  layout  of  the  prototyping  board 
used  to  construct  the  digital  autopilot  circuit  for  interfacing  with 
a hybrid  simulator.  This  chapter  will  describe  how  the  various  com- 
ponents were  selected  and  how  the  associated  circuits  operate. 

Hardware  Selection 

Microprocessor.  Although  hardware  selection  involves  many  com- 
ponents, the  critical  issue  is  the  selection  of  the  microprocessor. 

The  following  items  were  considered  in  examining  the  various  micro- 
processors: 

1.  Basic  CPU  Data  Word  Length.  The  basic  selection  process 
is  essentially  the  choice  between  eight-bit  and  sixteen-bit  data  word 
length.  At  the  time  this  project  was  started,  there  were  only  a few 
sixteen-bit  processors  available,  with  others  due  to  be  on  the  market 
soon.  Since  one  of  the  primary  objectives  of  this  project  is  a very 
low-cost  system,  the  sixteen-bit  processors  were  not  considered  since 
their  current  cost  (plus  support  items)  is  considerably  higher  than 
eight-bit  processors.  It  should  be  noted  that  this  condition  is  not 
likely  to  last  forever,  and  a re-evaluation  of  the  feasibility  of 
using  a sixteen-bit  processor  should  be  made  in  the  near  future  due  to 
their  increased  performance  capability.  An  eight-bit  processor  can 
still  meet  the  flight  control  algorithm  word-length  requirements  by 
means  of  multiple-precision  arithmetic.  The  disadvantage  of  this  method 
is  reduced  execution  speed,  but  if  excess  capability  exists,  few 
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Prototyping  Board  Layout 


problems  will  be  encountered. 

2.  Power  Consumption.  RPV  electrical  power  is  derived  from 
an  engine  alternator/nickel-cadmium  battery  combination.  Although 
no  strict  upper  limit  of  autopilot  power  consumption  has  been  estab- 
lished, the  lowest  possible  power  consumption  is  desirable  since 
other  systems  (telemetry,  tracker,  etc.)  are  constantly  being  added 
that  compete  for  the  limited  amount  of  power  available. 

Since  the  RPV  power  system  is  a +28V  supply,  it  is  therefore 
desirable  that  the  microprocessor  not  require  any  negative  voltages. 
Although  negative  voltages  can  be  generated  with  additional  circuitry, 
the  constraints  of  cost,  size,  and  weight  dictate  that  a single 
voltage  processor  be  used. 

3.  Speed.  The  autopilot  algorithms  contain  many  multiplica- 
tions  that  are  very  time-consuming  when  accomplished  in  software. 
Although  a dedicated  high-speed  hardware  multiplier  could  be  used,  the 
cost,  size,  weight,  and  power  constraints  make  this  option  undesirable. 

f 

Thus,  short  instruction  times  (i.e.  high  speed)  is  an  important  factor 
in  this  appl ication. 

| 

4.  Cost.  Most  eight-bit  microprocessors  are  in  the  same 

' general  price  range.  However,  the  support  circuitry  required  to  operate 

I 

them  may  vary  widely.  Thus,  the  complete  system  required  to  implement 
an  autopilot  function  should  be  examined  to  insure  lowest  cost  com- 
mensurate with  desired  performance  characteristics.  Since  hardware 
cost  is  largely  a function  of  chip  count,  the  same  argument  can  also 
be  used  to  minimize  size  and  weight. 
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A good  summary  of  the  characteristics  of  the  various  micropro- 
cessors is  found  in  Ref.  7*  page  56.  The  approach  taken  in  choosing 
a processor  was  to  define  a set  of  desirable  characteristics,  select 
all  processors  that  met  these  characteristics,  then  further  evaluate 
the  selections  to  arrive  at  a final  decision. 

The  initial  characteristics  desired  were:  eight-bit  word  length, 
single  chip  CPU,  single  power  supply,  on-chip  clock,  and  interrupt 
and  DMA  capability.  Three  processors  met  the  above  characteristics: 
Intel  8085,  Motorola  M6802,  and  RCA  CDP1802.  In  terms  of  speed,  the 
8085  is  fastest  (1.3  ysec  shortest  instruction),  the  6802  is  second 
(2  ysec)  and  the  1802  third  (2.5  ysec).  The  1802  has  a decided  ad- 
vantage in  terms  of  power  consumption,  1.6  mA  versus  100  mA  for  the 
6802  and  170  mA  for  the  8085.  Being  a CMOS  structure,  the  1802  also 
has  an  advantage  in  terms  of  high  noise  immunity.  This  could  be  parti- 
cularly important  in  light  of  the  severe  environment  in  which  the 
autopilot  must  work  (near  an  ignition  system,  alternator,  servo  motors, 
downlink  telemetry  transmitter,  and  a microwave  tracker). 

It  appears  that  none  of  the  microprocessors  has  an  overwhelming 
advantage  over  the  others;  each  has  its  own  strengths  and  weaknesses. 
The  RCA  CDP1802  was  finally  chosen  based  on  several  factors:  low 
power  consumption,  good  noise  immunity,  system  build-up  with  a minimum 
of  support  items  (i.e.  low  chip  count),  easily  implemented  input/ 
output  programming,  indirect  oriented  architecture  that  makes  pro- 
gramning  without  an  assembler  reasonably  easy,  previous  programming 
experience  with  the  1802,  and  ready  availability  of  a microcomputer 
board  based  on  the  1 802 . 
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Analog  to  Digital  Converter.  While  the  characteristics  of  avail- 
able analog  to  digital  (A/D)  converters  were  being  reviewed,  National 
Semiconductor  introduced  the  ADC  0816,  a complete  data  acquisition 
system  on  one  chip  (Ref  1 ).  Its  features  include:  eight-bit  suc- 
cessive approximation  conversion,  maximum  of  100  ysec  conversion  time, 
sixteen-channel  analog  multiplexor  with  latched  address  decoders,  an 
output  latch  and  Tri-State  output  buffer,  and  a single  5V  power  supply 
requirement  that  consumes  only  15  milliwatts.  This  is  the  first  time 
that  such  a circuit  has  been  available  in  monolithic  form  (and  at 
low  cost),  and  as  such,  was  a natural  choice  for  this  project.  Another 
plus  (and  somewhat  unique)  feature  of  the  ADC  08 1 6 is  the  use  of  256R 
resistor-ladder  netword  to  insure  a morotonic  response,  an  important 
feature  in  a control  application  since  non-monotonic  response  could 
cause  unwanted  positive  feedback  and  potential  oscillations  (Ref  8 ). 

As  described  in  Chapter  III,  an  eight-bit  A/D  is  sufficient  for  system 
requi rements. 

Digital  to  Analog  Converter.  A similar  situation  to  the  one 
encountered  whiie  searching  for  an  A/D  converter  was  encountered  during 
the  search  for  a suitable  digital  to  analog  (D/A)  converter.  Signetics 
introduced  a D/A  converter  system  on  a single  chip,  the  NE  5018  (Ref  1**) . 
It  contains  an  eight-bit  D/A  converter,  an  input  latch,  a voltage  ref- 
erence, and  an  output  amplifier.  The  main  drawback  of  the  NE  5018  for 
thi s.  appl icat ion  is  that  it  requires  both  positive  and  negative  supply 
voltages,  a situation  which  is  undesirable  since  the  aircraft  has  only 
positive  voltages  available  and  required  negative  voltages  will  have 
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to  be  generated.  It  was  decided  that  the  cost,  space,  and  weight 
savings  of  using  the  NE  5018  would  more  than  offset  the  additional 
circuitry  required  to  generate  a negative  voltage.  This  is  parti- 
cularly true  since  the  savings  of  using  the  NE  5018  are  multiplied 
by  three  since  three  D/A's  are  required.  It  is  anticipated  that  an 
equivalent  part  requiring  only  a positive  voltage  will  eventually  be 
introduced  by  some  manufacturer,  and  the  switch  to  that  part  should 
cause  a minimum  number  of  changes. 

Hardware  Multiplier.  As  stated  earlier,  software  multiplications 
are  very  time-consuming.  Initially,  there  was  some  concern  that  the 
microprocessor  might  not  operate  fast  enough  to  accomplish  the  control 
algorithm  using  software  multiplication,  so  a hardware  multiply  chip 
was  obtained  for  use  if  this  was  the  case.  (The  multiply  chip  was  not 
needed.)  The  multiply  chip  selected  was  the  TRW  TDC  1008J (Ref  36).  This 
is  a high  performance  monolithic  chip  with  a speed  much  higher  than 
this  application  requires  (70  psec) , but  is  the  best  choice  at  the 
present  time.  If  a multiply  chip  is  needed  in  the  future  due  to  ad- 
ditional functions  incorporated  into  the  autopilot,  a soon-to-be- 
released  chip,  the  RCA  CDP 1 855  multiply/divide  unit,  should  be  ideal 
for  this  application  due  to  lower  cost,  power  consumption,  and  com- 
patability  with  RCA  1 802/1 804  MPU  architecture. 

Hardware  Development 

t Microcomputer.  An  "ELF  II"  microcomputer  kit  was  used  as  the 
microprocessor-based  system  for  prototyping  (Ref  19).  This  board 
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contains  a hex  keyboard,  two-digit  hex  LED  readout,  256  bytes  of  RAM, 

5 volt  power  supply,  and  a region  of  PC  board  capable  of  accepting 
five  expansion  board  sockets.  One  such  board,  called  a "Giant  Board", 
was  utilized  (Ref  23)*  Features  of  the  "Giant  Board"  that  are  useful 
in  this  application  include:  a 256  Byte  ROM  operating  system  that 
allows  direct  examination  of  any  memory  location,  direct  change  of 
any  memory  location,  program  execution  start  at  any  memory  location, 
a cassette  read  and  write  (software  UART  function),  and  an  input  and 
output  address  decoder.  Both  the  "ELF  II"  and  "Giant  Board"  (schematics 
are  included  in  Appendix  C ) contain  additional  capabilities  that  were 
not  used  in  this  application. 

The  "ELF  II"  uses  a 3.58  MHZ  crystal  and  a divide  by  two  circuit 
to  obtain  a 1.79  MHZ  clock  frequency.  This  is  used  to  obtain  compata- 
bility  with  a TV  interface  1C  on  the  board.  Since  the  TV  interface 
is  not  used  in  this  application,  the  crystal  was  changed  to  5.16  MHZ 
to  obtain  a 2.58  MHZ  clock  frequency.  The  clock  frequency  may  be 
increased  to  a maximum  of  3*2  MHZ  when  the  CDP  1 802  is  operated  at  5 
volts  (which  it  is  in  this  design). 

An  Elite  board  (prototyping  board)  was  used  to  mount  the  remain- 
ing components  required  to  construct  the  autopilot.  Cables  were  used 
to  connect  the  "ELF  II"  and  Elite  board.  A prototyping  board  strip 
was  glued  to  the  "ELF  II"  in  order  to  make  connections  to  it. 

A/D  Circuitry.  Fig.  5-2  shows  the  circuitry  used  to  interface 
the  ADC  08 1 6 data  acquisition  chip  to  the  system.  The  multiplexor 
address  is  routed  over  the  four  LSB's  of  the  data  bus.  Therefore,  to 
send  an  address  to  the  multiplexor  a value  of  00  to  OF  is  sent  to 
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provide  an  address  of  input  0 through  input  15.  respectively.  The 
instruction  used  to  output  the  address  is  67  (value  of  7 on  I/O 
address  lines)  which  also  latches  the  multiplexor  address  and  starts 
the  conversion  process.  This  is  accomplished  by  using  the  I/O 
address  decoders  on  the  "Giant  Board"  as  an  indicator  of  instruction 
67.  The  output  of  the  "Giant  Board"  I/O  address  decoder  is  ANDed 
with  TPB  (a  timing  signal  from  the  CPU)  to  insure  the  multiplexor 
address  is  stable  when  the  multiplexor  latches  the  address. 

A one-shot,  SN  74121  (Ref  50) , is  required  between  the  A/D's 
end  of  conversion  (EOC)  signal  and  the  CDP  l802's  interrupt  input. 

If  the  two  were  connected  by  just  an  inverter,  the  interrupt  signal 
would  still  be  present  when  the  interrupt  routine  completed,  and  the 
program  would  be  locked  in  an  interrupt  routine  loop.  The  output  of 
the  one-shot  must  be  long  enough  to  insure  the  executing  instruction 
completes  (>  longest  instruction  time),  but  shorter  than  the  interrupt 
routine.  The  one-shot  pulse  width  is  given  by  (Ref  50) : 

<««>  - Ce*t  *T  (5-’> 

Using  C = .033  yF  and  the  internal  2K  resistor  results  in  a pulse  width 
of  approximately  46  ysec,  during  which  approximately  7-5  instructions 
will  execute  (with  a 2.58  MHZ  clock  frequency).  Since  the  interrupt 
routine  to  input  data  from  the  A/D  is  10  instructions  in  length,  the 
one-shot  will  have  removed  the  interrupt  condition  before  the  interrupt 
routine  completes.  Note  that  if  the  1802  clock  frequency  is  increased, 
the  value  of  the  capacitor  used  with  the  one-shot  may  have  to  be  de- 


creased so  that  the  interrupt  routine  does  not  complete  before  the  one- 


shot  times  out. 


A .001  pF  capacitor  was  connected  between  the  multiplexor  out 
(pin  15)/comparator  in  (pin  18)  loop  and  ground.  This  was  necessary 
to  filter  out  noise  being  generated  in  the  multiplexor  (switching 
noise).  Without  this  capacitor  the  A/D  produced  a one-bit  jitter  in 
its  output.  Also,  a 15  pF  capacitor  was  connected  between  each  analog 
input  and  ground  to  filter  out  any  noise  that  might  be  generated  by 
the  sensors  or  picked  up  in  transmission.  As  determined  experimentally, 
the  corner  frequency  of  this  filter  is  about  150  Hz. 

D/A  Circuitry.  Fig.  5~3  shows  the  circuitry  used  to  interface 
the  NE  5018  D/A  converter  circuitry  with  the  system.  The  basis  of 
the  circuit  is  the  recommended  circuit  given  in  the  Signetics  applica- 
tion bulletin  (Ref  14).  An  external  feedback  resistor  of  4.7  K was 
added  to  the  output  amplifier  (pins  18  and  20)  to  reduce  the  output 
voltage  range  to  about  5 volts.  The  adjustment  to  obtain  exactly  5 
volts  full  scale  is  made  at  the  potentiometer  connected  between  pins 
13/14  and  ground. 

The  Latch  Enable  (LEj  signal  is  obtained  from  the  appropriate 
output  of  the  I/O  address  decoder  on  the  "Giant  Board".  Instruction 
63  latches  a value  in  the  yaw  axis  D/A,  instruction  65  into  the  roll 
axis,  and  instruction  66  into  the  pitch  axis.  The  signal  from  the  I/O 
address  decoder  is  ANDed  with  TPB  (timing  signal  from  the  CPU)  to  insure 
the  input  data  from  the  bus  is  stable  before  the  data  is  latched.  The 
result  is  inverted  (thus  a NAND  is  used)  to  obtain  the  correct  polarity. 

: A IK  resistor  is  connected  between  the  D/A  output  and  ground  to 
insure  a constant  load  on  the  output  amplifier.  Also,  a 10  pF  capaci- 
tor is  connected  between  the  output  and  ground  to  filter  any  noise. 
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gure  5~3:  Digital  to  Analog  Converter  Circuitry 


such  as  major  transition  glitches  (Ref  13). 

Memory.  The  software  requires  656  eight-word  bytes  of  memory. 

Since  the  basic  "ELF  II"  system  contains  only  256  bytes,  two  addi- 
tional blocks  of  256  bytes  each  had  to  be  added.  Fig.  5-4  shows 
the  circuitry  used.  Since  the  CDP  1802  has  only  eight  address 
lines,  time  multiplexing  must  be  used  to  send  a sixteen-bit  address. 

The  addross  upper  byte  is  sent  out  and  latched,  then  the  address 
lower  byte  is  sent  out.  With  full  decoding  of  the  upper  byte,  up 
to  65536  bytes  of  memory  can  be  addressed.  However,  full  decoding 

of  the  address  upper  byte  can  be  avoided  if  eight  or  less  blocks 

(1  block  = 256  bytes)  are  all  that  is  required.  The  lits  of  the  upper 

byte  can  be  directly  latched  if  only  one  bit  is  high  at  a time.  With 

this  scheme,  additional  blocks  can  be  addressed  as  01XX,  02XX,  04XX, 

08XX,  10XX,  20XX,  40XX,  and  80XX.  In  this  application,  Bits  0 and  2 
were  latched  in  a CD4042  D flip-flop  (Ref  12)  so  that  the  two  addi- 
tional blocks  are  addressed  as  0100-01FF  and  0400-04FF.  The  original 
256  bytes  on  the  "ELF  I I"  board  are  addressed  as  0000-00FF  and  have 
no  address  upper  byte  selection  (selected  all  the  time).  Thus,  this 
block  must  be  disabled  whenever  either  of  additional  two  blocks  is 
selected.  This  is  accomplished  by  connecting  the  inverted  output  of 
each  latch,  i^,  to  the  chip  select  line  of  the  "ELF  II"  memory  via  a 
diode.  The  "ELF  II"  chip  select  pin  is  normally  held  high  by  connect- 
ing it  to  +5  volts  through  a 10K  resistor  (on  the  "Giant  Board"). 

Whenever  either  of  the  additional  blocks  is  not  selected,  is  high 
and  has  no  effect  on  the  "ELF  II"  memory.  However,  when  01XX  or  04XX 
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is  selected,  or  go  low  and  ground  the  chip  select  pin  of  the 
"ELF  II"  memory,  thus  disabling  it.  The  diodes  act  to  provide  an  OR 
function  (diode  logic)  between  the  selection  of  additional  blocks  of 
memory. 

Timer.  Fig.  5-5  is  the  circuit  used  for  precise  control  of  the 
sampling  rate  (T).  It  is  a standard  NE  555  circuit  from  the  Signetics 
applications  note  for  an  astable  (free-running)  pulse  generator  (Ref  49) , 
After  completing  an  iteration  through  all  three  axes,  the  program  tests 
EF3  (which  is  connected  to  the  timer  circuit)  and  waits  for  the  output 
to  go  low.  When  a low  is  detected,  the  program  branches  back  to  the 
beginning  to  repeat  the  sequence.  The  time  the  output  is  low  must  be 
long  enough  to  insure  detection  (>  2 instruction  times),  but  shorter 
than  the  time  to  execute  the  complete  code  of  one  pass  through  the 
program.  The  output  low  time,  t2*  is  given  by  (Ref  49): 


t2  = .693  (Rb)  C 


(5-2) 


Using  C = .22  yF  and  R = 2.7K,  then: 

D 


t^  = 4l 1 ysec 


which  is  long  enough  for  approximately  66  instructions  to  execute. 

The  total  time,  T = t.  + t , should  = 20  msec  for  a 50  HZ  sampling 

i 2 

rate.  The  output  high  time,  t^,  is  given  by  (Ref  49): 


= .693  (Ra  + Rb)  C 


Since  = T-t2  = 20  msec  - 411  ysec  = 19. 5S  msec,  then 


(5-3) 


R.  = -Li - R-  126  K 

A 7593C  B 


100  kfl 


+5  v 


is  composed  of  a 100K  resistor  and  a 100K  potientiometer  for  pre- 
cise adjustment.  Note:  Jumper  J8  on  the  "Giant  Board"  must  be 
removed  in  order  to  utilize  EF-3. 

Power.  For  simulation  purposes,  a standard  tri-voltage  lab 
power  supply  was  used  to  obtain  +5,  +15,  and  -15  volts.  For  actual 
proto-type  construction,  it  is  recommended  that  three-terminal  regu- 
lators be  used  to  obtain  +5  and  +15  volts,  and  a Burr-Brown  Model  700 
isolated  DC/DC  converter  be  used  to  obtain  -15  volts  from  +15  volts 
(Ref  16). 

Support  Circuitry.  For  simulation  purposes,  TTL  parts  were  used 
for  the  various  random  logic  gates  required  (Ref  50).  For  prototype 
construction,  it  is  recommended  they  be  replaced  with  CMOS  equivalents 
for  lower  power  consumption  and  better  noise  immunity  (Ref  12). 

Along  with  the  software  developed  in  the  next  chapter,  the  cir- 
cuitry described  in  this  chapter  was  used  to  test  the  feasibility  of 
a microprocessor-based  RPV  autopilot.  A hybrid  simulation  of  the  RPV 
dynamics  was  used  and  test  procedures  and  results  are  described  in 
Chapter  7- 
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VI.  Software  Development 


Transformation  of  the  general  autopilot  algorithms  into  computer 
software  is  conceptually  a simple  process,  but  in  practice  can  present 
some  significant  problems  due  to  word  length,  CPU  speed,  etc.  The 
purpose  of  this  chapter  is  to  describe  such  a transformation.  The 
first  item  to  be  described  is  the  derivation  of  a single  axis  autopilot 
flow  chart.  Then  the  flow  chart  for  the  washout  (high  pass)  filter  in 
the  yaw  axis  is  developed.  Finally,  the  complete  3~axis  (including  yaw 
filter)  flow  chart  is  developed  by  combining  the  washout  filter  and 
three  similar  single  axis  routines  into  a single  program.  The  CDP  1802 
program  listing  is  in  Appendix  E. 


Autopilot  Loop  Algorithm  Development 

A basic  autopilot  block  diagram  is  shown  in  fig.  6-1. 


Figure  6-1:  Basic  Autopilot  Block  Diagram 
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The  basic  autopilot  algorithm  (exclusive  of  any  filters)  consists  of 


multiplying  the  input  to  the  inner  loop  (rate)  by  a constant  (Cj), 
multiplying  the  input  to  the  outer  loop  (attitude  = att)  by  a constant 
(C^),  summing  the  two  products,  and  outputting  the  negative  of  the  sum. 

In  equation  form: 

Output  = - [-  (rate)  + C2  (atoj  (6-0 

However,  in  the  XBQM-106,  all  signals  use  a 2.5  volt  zero  reference, 

(0-5  volts,  2.5  volt  center).  Thus,  the  constants  must  be  multiplied 
by  the  deviation  from  2.5  volts,  not  the  actual  input  voltage.  This  is 
accomplished  by  subtracting  2.5  volts  from  each  input  before  multipli- 
cation, then  adding  2.5  volts  to  the  final  sum: 


Output 


C 

_ 


C,  (rate  - 2.5)  + C,  (att 


- 2.5)] 


+ 2.5 


(6-2) 


Since  unsigned  magnitude  arithmetic  was  selected  for  use  in  the  micro- 
processor (because  the  A/D  output  is  unsigned  magnitude),  the  terms 
must  be  rearranged  to  prevent  negative  intermediate  results: 


Output  = 


- [c,  (rate)  - C,  (2.5)  + C2  (att)  - C2  (2.5)]  + 2.5 

- C1  (rate)  + C2  (att)  - 2.5  (C,  + C2j  + 2.5 

- C}  (rate)  + C2  (att)  - 2.5  (C,  + C2)  + 2.£|  + 5 

5 - [c,  (rate)  + C2  (att)  - 2.5  (C,  + C2  - 1)] 


(6-3) 


Thus,  the  term  in  brackets  represents  the  uninverted  output,  subtracting 
it  from  5 inverts  it  (provides  negative  feedback). 

Since  analog  full  scale  is  5 volts  and  digital  full  scale  is  256 
(maximum  value  of  8 bit  word  = 28),  the  analog  to  digital  conversion 
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essentially  multiplies  the  inputs  by  = 51.2  per  volt.  Conversely, 

5 

the  digital  to  analog  conversion  divides  the  output  by  51.2.  Thus,  to 
maintain  an  equality,  all  terms  of  Eq  (6-3)  must  be  multiplied  by  51.2: 


Output  (51.2)  = 5 (51.2) 


(rate  * 51.2}  + C2  (att  • 51.2} 

- 2.5  (C  + C - 1)51. 
1 2 


Output  (51.2)  = 256  - Cj  {rate  * 51.2}  + C£  (att  * 51.2} 


128  (c1  + c2 


Also,  since  fixed  point  arithmetic  is  used,  a "pseudo  floating  point" 
method  must  be  used.  This  is  because  all  the  input  multiplication  con- 
stants (loop  gains)  are  in  the  range  .3  to  2.7.  Rounding  to  the  nearest 
integer  can  result  in  excessive  errors.  For  example,  a constant  of  1.4 
would  round  to  1 , an  error  of  approximately  29%.  The  "pseudo  floating 
point"  method  used  to  overcome  this  problem  was  to  multiply  all  inputs 
by  an  additional  constant,  then  divide  the  output  by  the  same  constant. 

The  division  is  accomplished  by  shifting  the  binary  point  to  the  left, 
a very  fast  method  of  division.  Obviously,  the  additional  constant  must 
be  a power  of  2 to  enable  division  by  binary  point  shifting.  The  larger 
the  additional  constant,  the  less  rounding  error  that  will  occur.  How- 
ever, the  size  of  the  computer  data  word  limits  the  maximum  size.  Eq  (6-5) 
illustrates  the  use  of  the  additional  constant,  2n,  where  n is  an  integer. 

{Output  (51.2)}  2n  = 256  (2n)  - [2°  (C,)  {rate  (51.2)} 

. + 2n  (C2)  {att  (51.2)}  - 128  (C1+C2-1)  2^]  (6-5) 
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The  contents  of  the  brackets  consists  of  three  terms,  the  first 
two  of  which  are  always  positive,  and  the  last  one  which  is  always 
negative  (assuming  > 1 , which  is  always  the  case  in  this 

application).  Each  of  the  first  two  terms  consists  of  an  eight-bit 
constant  (2n)*(C)  times  an  eight-bit  input  (input)-(51.2)  which  results 
in  a sixteen-bit  product.  Two  such  products  are  added  together,  but 
the  sum  is  still  limited  to  sixteen  bits.  To  determine  the  largest 
value  of  2°  allowable,  a worst  case  situation  is  considered  in  which 
both  inputs  are  maximum.  In  this  case: 

1 6-b i t sum  = 2°  (C,)  (256)  + 2n  (C2)  (256) 

= 256  (2n)  (Ct  + C2) 

If  we  limit  + C2  4 (a  reasonable  assumption  for  this  application), 
the  largest  value  of  2n  can  be  determined.  Since  the  largest  value  of 
a sixteen-bit  word  is  216  = 65536,  then 

i 

65536  = 256  (2n)  (4) 

2n  = 64 

which  is  an  exact  power  of  two.  Substituting  into  Eq  (6-5)  yields: 

{Output  (51 .2) } 64  = 256  (64)  " [f4  * C1  {rate  (5W2)} 

+ 64  • C2  {att  (51.2)}-  8192  (C]  + C2  - ij 

In  actual  practice,  the  inversion  process  (subtraction  of  the  term  in 
brackets  from  256  • 64)  is  accomplished  after  the  binary  point  is  shifted 
six  places  left  to  effect  a division  by  64. 
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: 


Output  (51 .2)  = 256-[6i»C1{rate(51.2)}+6i4C2{att(51.2)}-8l92(C1+C2- 
_ 


64 


9 


Output  = 256- 


6i*C1{rate(51.2)}+61»C2(att  (51. 2)  >-8192(0^02-1) 


64 


51.2 


(6-6) 


Note  that  division  by  64  is  accomplished  by  binary  point  shifting  and 
the  division  by  51.2  is  accomplished  by  the  digital  to  analog  conversion. 

In  actual  use  a rounded  constant  must  be  used.  For  example,  if 
C1  = 1.7,  then  640^  = 108.8,  which  rounds  to  109.  The  that  is  actu- 
ally used,  called  Cj ' , must  then  be  calculated. 


C, ■ = = 1.703125 

The  same  procedure  must  be  followed  for  C2  to  obtain  02'.  C^1  and  C2' 

are  then  used  in  Eq  (6-6). 

As  previously  noted,  autopilot  inputs  and  outputs  are  in  the  2.5 
± 2.5  volt  range.  However,  since  some  of  the  constants  are  greater  than 
unity,  the  algorithm  may  calculate  outputs  greater  than  5 volts  or  less 
than  zero.  For  example,  using  Eq  (6-6):  If  = .5,  C2  = 2,  rate  input 

= 2.5,  and  attitude  input  = 4,  an  output  of  -.5  is  generated.  Changing 
the  attitude  input  to  1 results  in  an  output  of  5.5. 

Since  the  I/O  hardware  is  not  capable  of  generating  voltages  out- 
side the  0-5  volt  range,  limiters  must  be  used  to  prevent  erroneous 
results.  Such  limiters  are  implemented  in  software.  Rearranging  Eq 
(6-6)  gives: 

[256-Output (5 1.2)]  64  * 64C1 (rate  (51.2)}+64C2{att(51.2)}-8l92(C1+C2-l) 

106 


4 


t 


MM* 


r 


t 


i 

f 

! 

( 


( 

i 

t 

l 


■ 

! 


Substituting  the  minimum  and  maximum  output  values,  0 and  5,  into  the 
left  side,  the  right  side  of  the  equation  is  shown  to  be  limited  to 
the  range  0 to  1 6384 . The  limiter  is  accomplished  as  follows: 

If: 

[6l*C1{rate(51.2)}+64C2{att(51.2)}-3l92(C1+C2-l]]  > 16384 

64C1(rate(51.2)}+64C2(att(51.2)}  - [[6384+8 1 92(C,+C2- ij)  >0  (6-7) 

then  output  = 0. 

Also,  if 

64Cj{rate(51.2)}+64C2{att(51.2)}-8l92(C1+C2-l)  < 0 (6-8) 

then  output  = 5. 

The  flowchart  in  fig.  6-2  summarizes  the  single  axis  algorithm. 


Filter  Algorithm  Development 

So  far,  the  autopilot  algorithms  have  been  described  without 
regard  to  filters.  However,  the  XBQM-106  autopilot  contains  a washout 
(high-pass)  filter  in  the  yaw  axis.  The  basic  digital  algorithm  (or 
linear  difference  equation)  for  this  filter  (described  in  Chapter  IV)  is: 


Y(k)  = A0-X(k)  +A  *X(k-1)  +A2-X(k-2)  +B1«Y(k-1)  +B2*Y(k-2)  (6-9) 


where: 


X(k)  = current  filter  input 

X (k-1 ) = filter  input  from  previous  iteration 

X(k-2)  = filter  input  from  2 iterations  back 

Y(k)  = calculated  filter  output 

Y (k— 1 ) = calculated  filter  output  from  previous  iteration 

Y(k-2)  = calculated  filter  output  from  2 iterations  back 
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Again,  since  the  XBQM-106  uses  a 2.5  volt  zero  reference  (2.5  ± 

2.5  V),  the  signals  must  mathematically  be  shifted  to  a zero  volt  zero 
reference,  the  calculations  performed,  then  the  output  shifted  back  up 
2.5  V. 

As  a result: 

Y(k)  = Ao[x(k)-2.5]+A1  [x(k-1)-2.0+A2^(k-2)-2.5]+B1[Y(k-l)-2.5| 

+B2[Y(k-2)-2.5]+2.5 

Rearranging  to  avoid  negative  intermediate  results  yields: 

Y(k)  = Aq»  X (k)  +A1*X(k-l)  +A2*  X(k-2)  +B1*Y(k-l)  +B2«Y(k-2) 

-2 . 5 ( Aq+A, +A2+B , +B2- 1 ) (6-10) 

The  actual  values  of  the  constants  (obtained  from  Chapter  IV)  are  as 
follows: 

AQ  = .98762018 

A,  = -1.9752A04 

a2  = .98762018 

B,  = 1.9751712 

b2  = - .97530950 

If  these  constants  are  rounded  to  the  nearest  integer,  the  values 
become  1,  -2,  1,  2,  -1,  respectively.  Since  the  filter  characteristics 
are  quite  sensitive  to  the  accuracy  of  the  constants,  an  additional 
constant  will  again  have  to  be  employed  to  reduce  roundoff  error.  Each 
term  will  be  multiplied  by  the  constant,  then  the  final  result  divided 
by  the  constant  to  recover  Y(k).  The  division  is  accomplished  by  binary 
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point  shifting,  thus  the  constant  must  again  be  of  the  form  2n,  where 
n is  an  integer. 


Y(k)-(2n)  = 2n(A0)X(k)+2n(A1)X(k-l)+2n(A2)X(k-2)+2n(B1)Y(k-l) 

+2n(B2)Y(k-2)-2n(2.5) (A  +A1+A2+B,+B2-1 ) 

The  larger  that  2n  is,  the  less  roundoff  error  will  occur;  how- 
ever, it  should  be  small  enough  to  avoid  overflowing  the  sixteen-bit 
sums  during  intermediate  steps.  Since  unsigned  magnitude  arithmetic 
is  used,  the  terms  with  positive  constants  must  be  added  first  to 
avoid  negative  sums.  Thus,  positive  terms  will  determine  the  maximum 
value  of  2n. 

2n(AQ)  X(k)  + 2n(A2)  X(k-2)  + 2n(B1)  Y(k-l)  <65536 

Using  a worst  case  of  256  for  X (k) , X(k-2)  and  Y(k-1),  and  substituting 

for  A . A.  and  B,: 
o’  2 1 

2n ( .98762018) (256)+2n(. 98762018) (256)+2n(l .9851712) (256)  £ 65536 
2n(101 1.305359)  < 65536 
2n  < 64. 80337459 

Therefore,  let  2°  = 64,  which  yields 

Y (k)*(64)  = 64(Ao)X(k)+64(A1)X(k-l)+64(A2)X(k-2)+64(B1)Y(k-l) 

+64(B,)Y(k-2)-64(2.5)(A  +A.+A,+B1+B  -1)  (6-11) 

/ Ol/IZ 
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Multiplying  each  constant  by  64  and  rounding  yields: 


.93762018  (64)  = 63. 20769152 


-1.9752404  (64)  = -126.4153856 

.98762018  (64)  = 63.20769152 

1.9751712  (64)  = 126.4109569 

-.97530950  (64)  = -62.419808 


Dividing  each  rounded  result  by  64  yields  the  actual  value  of  the  con- 
stant used. 


*0'  - ST  ' -W™ 

V -ir  -"-M” 


A • m 83 

"2  pr 

B * = 

1 

B ' = 

2 64 


.984375 

1.96875 

-.96875 


Substituting  these  values  in  Eq  (6— 11)  yields: 


Y(k)-(64)  = 63 - X (k)  — 1 26 -X ( k- 1 ) +63*X(k-2)  +126-Y(k-1)  -62-Y(k-2) 

-64 (2 . 5) ( . 984375- 1 . 96875+. 984375+1 . 96875- . 96875- 1 ) 


Y (k)*(64)  = 63 - X (k)  — 1 26 * X ( k— 1 ) +63'X(k-2)  +126* Y(k-l)  -62-Y(k-2)  -0 


Y (k)  = 63- X(k)  +63* X(k-2)  +126-V(k-1)  -126-X'k-l)  -62*Y(k-2) 

64 

The  division  by  64  is  accomplished  by  binary  point  shifting. 


(6-12) 
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While  the  inputs  are  eight  bits,  the  intermediate  sums  and  filter 
output  are  sixteen  bits  (only  eight  bits  are  output  from  the  filter 
algorithm;  however,  sixteen  bits  are  available  internal  to  the  algor- 
ithm). It  was  found  experimentally  that  eight  bit  accuracy  of  Y ( k— 1 ) 
and  Y ( k— 2 ) was  not  sufficient  to  provide  proper  filter  results  (see 
explanation  in  Chapter  IV).  The  solution  was  to  break  Y(k-l)  and  Y (k— 2) 
into  two  terms,  integer  and  fraction,  to  achieve  sixteen  bit  accuracy 
in  these  terms.  Since  the  fractional  part  is  stored  as  an  integer 
number,  the  product  of  the  integer  portion  times  a constant  must  be 
divided  by  eight  (using  binary  point  shifting)  before  inclusion  in  the 
summation. 

Y(k)  =(63-X(k)  +63-X(k-2)  +126-Y(k-l)  |nt  +{126-Y(k-1)  frac*8} 

-1 26- X (k-1 ) -62-Y(k-2)  . -(62'Y(k-2)  . t8U 

int  frac 


(6-13) 


Another  situation  that  requires  additional  consideration  is  the 
filter  response  to  a step  input.  A step  of  sufficient  magnitude 
(depends  on  prior  inputs  and  outputs,  but  always  greater  than  2.5  volts) 
will  produce  overshoot  on  the  output.  In  many  cases,  this  presents  no 
problem;  however,  in  certain  cases  the  overshoot  will  carry  outside  the 
0-5  volt  output  range  (0-256  internally).  Since  the  hardware  cannot 
generate  such  values,  the  algorithm  enters  an  e oneous  and  irrecoverable 
state.  To  prevent  such  an  occurrence,  a software  check  is  made  to  en- 
sure that  a negative  result  does  not  occur  after  any  of  the  subtractions, 
and  that  the  final  sum  (before  division  by  6M  does  not  exceed  16383 


( 256(64)  -1  = 3FFF.|g).  such  a condition  occurs,  X(k-l),  X(k-2), 
Y(k-l),  and  Y(k-2)  are  reinitialized  to  128  to  make  it  "look"  like 
the  step  origin  was  from  128  (2.5  V),  then  Y(k)  is  recalculated.  This 
will  correct  any  situation  since  the  problem  cannot  occur  whenever  the 
step  magnitude  <_  128.  The  conditions  leading  to  this  problem  were 
examined  by  executing  the  algorithm  on  a HP-29C  programmable  calcula- 
tor, one  step  at  a time.  This  allowed  for  analysis  of  the  situation 
and  formulation  of  a recovery  technique.  As  a by-product,  the  algor- 
ithm does  not  need  initialization;  it  is  self-initializing  whenever 
erroneous  results  occur.  The  HP-29C  program  is  listed  in  Appendix  D, 
Fig.  6-3  lists  the  complete  filter  algorithm. 


In  the  3-axis  autopilot  program,  the  filter  routine  is  interleaved 
with  the  data  inputs.  The  A/D  conversions  are  accomplished  in  parallel 
with  the  filter  routine,  interrupt  I/O  being  used  to  input  data  when 
A/D  conversion  is  complete.  This  technique  is  possible  because  A/D  con- 
versions take  approximately  220  usee  (could  be  decreased  to  100  ysec,  if 
necessary)  while  each  software  multiplication  takes  from  650  to  800  ysec 
(determined  by  number  of  instructions  x instruction  time).  Fig.  6-4 
is  a flowchart  of  the  entire  3~axis  autopilot  program.  The  actual  pro- 
gram listing  is  in  Appendix  E . The  values  of  constants  used  are 
listed  in  fig.  6-5,  while  the  CPU  register  assignments  are  listed  in 
fig.  6-6. 

The  complete  3-axis  program  also  contains  three  subroutines  (add, 
subtract,  and  multiply),  and  an  interrupt  routine  to  input  data. 


Calculations 
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i 

§ 

i 

\ 

i 
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RO 

Program  counter 

R1 

Interrupt  routine  pointer 

R2 

Stack  pointer 

R3 

- Multiply  subroutine  operand  1 pointer  and  result 

pointer 

- Add  and  subtract  subroutines  operand  1 pointer 

upper  byte 

R4 

- Multiply  subroutine  operand  2 pointer  and  result 

pointer 

- Add  and  subtract  subroutines  operand  2 pointer 

lower  byte 

R5 

Used  by  multiply  subroutine  for  accumulated  product 

R6.0 

Multiply  subroutine  loop  counter 

R6 

Pointer  to  ALE  address  location 

R7 

Multiply  subroutine  program  counter 

R8 

Subtract  subroutine  program  counter 

R9 

Add  subroutine  program  counter 

RA 

Pointer  for  input  data 

RB-RF 

Not  used 

. ■■  ■ J 

Figure  6"6:  CPU  Register  Assignments 
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Figure  6-7:  Interrupt  Routine  to  Input  Data 
Flowchart 


Figure  6-8:  Add  Subroutine  Flowchart 
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VII.  Test  Procedures  and  Results 


After  development  of  the  required  hardware  and  software,  the  result- 
ing system  was  tested  for  proper  operation.  Testing  was  accomplished 
in  several  stages  of  increasing  complexity.  The  results  were  then  evalu- 
ated to  determine  the  performance  of  the  digital  A/P,  and  thus,  a measure 
of  success  towards  meeting  the  study  objectives. 

Test  Procedures 

Testing  was  accomplished  in  two  basic  modes:  static  and  dynamic. 
Static  testing  involves  inputting  signals  from  a DC  power  supply  and/or 
AC  function  generator,  and  observing  the  output  on  an  oscilloscope  and/or 
chart  recorder.  This  mode  requires  no  special  equipment  and  can  be 
accomplished  in  the  School  of  Engineering  laboratories.  The  intent  of 
this  method  is  to  verify  the  basic  operation  of  the  algorithm  before 
proceeding  to  more  sophisticated  testing.  Such  items  as  gain  values, 
limiting  processes,  filter  operation,  and  frequency  limits  can  be  ob- 
served in  this  manner. 

Dynamic  testing  involves  interfacing  with  a six  degree  of  freedom 
hybrid  simulation  of  the  XBQM-106  aircraft,  sensors,  actuators,  and 
analog  A/P  that  is  resident  in  the  WPAFB  computer  center.  The  time 
responses  to  various  inputs  can  be  observed  in  this  manner,  and  the  digi- 
tal A/P  performance  can  be  compared  to  the  simulation  of  the  analog  A/P. 
(As  a by-product,  several  errors  in  the  hybrid  simulation  were  corrected 
when  %he  digital  A/P  response  failed  to  agree  with  the  analog  simulation.) 
In  order  to  facilitate  quick  hook-up  to  the  simulation  patch  board,  a 
special  cable  and  plug-in  printed  circuit  card  were  fabricated  to  allow 

122 


4 


i 


interfacing  by  simply  plugging  the  card  into  the  prototyping  board 


' 


A variation  of  the  dynamic  testing  mode  is  the  use  of  a mock-up 
control  station  to  input  pilot  commands  to  the  system.  Fig.  7“1  shows 
the  digital  A/P  connected  to  the  hybrid  simulation,  and  Fig.  1-2  shows 
the  control  station  mock-up. 

Testing  is  accomplished  in  order  of  increasing  complexity.  The 
following  is  a chronological  list  of  the  testing  process: 

Static  Single-Axis  Testing.  This  test  was  used  mainly  as  a soft- 
ware debugging  aid.  Once  the  algorithm  appeared  to  be  operating  prop- 
erly, the  next  step  could  be  accomplished. 

Dynamic  Single-Axis  Testing.  The  initial  attempt  of  this  method 
was  to  verify  proper  hook-up  to  the  hybrid  simulation.  Once  accomplished, 
time  responses  to  various  inputs  were  obtained.  Comparison  to  the  analog 
A/P  response  allowed  verification  of  the  A/P  loop  gains.  The  single- 
axis static  and  dynamic  tests  were  then  repeated  for  each  of  the  other 
two  axes.  Since  the  washout  filter  was  not  yet  incorporated  into  the 
yaw  axis,  it  was  disconnected  in  the  analog  simulation. 

Static  Filter  Testing.  This  method  was  used  to  assist  in  debugging 
the  yaw  washout  filter  software.  Once  proper  operation  was  obtained, 
the  filter  frequency  response  characteristics  were  recorded  on  a chart 
recorder,  and  are  discussed  in  the  results  section  of  this  chapter. 

Static  Single-Axis  w/Filter  Testing.  The  yaw  axis  software  and  the 
filter  software  were  combined  and  debugged. 

Dynamic  Single-Axis  w/Filter  Testing.  The  yaw  filter  in  the  analog 
simulation  was  reconnected  and  the  digital  A/P  response  compared  to  the 
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analog  simulation. 

Static  Three-Axis  (w/Fiiter  in  Yaw)  Testing.  The  software  for  the 
complete  A/P  was  developed  and  debugged. 

Dynamic  Three-Axis  (w/Filter  in  Yaw)  Testing.  The  digital  A/P 
responses  were  compared  to  the  analog  simulation,  applying  forcing  func- 
tions to  each  axis  separately,  then  all  three  axes  simultaneously. 

Axis  cross-coupling  effects  were  observed.  Time  responses  were  recorded 
on  chart  recorders  and  are  discussed  in  the  results  section  of  this 
chapter. 

Dynamic  Three-Axis  (w/Filter  in  Yaw)  Testing  Using  Command  Console. 

The  command  console  was  used  to  determine  which  of  the  effects  observed 
in  the  time  response  are  significant.  Personnel  from  the  Mini-RPV 

Group  (including  the  chief  flight  test  pilot)  were  utilized  to  provide 

» 

subjective  judgements  as  to  the  "handling  qualities"  of  the  digital  A/P 
compared  to  the  analog  A/P. 


Results 


Digital  Washout  Filter  Testing  Results.  The  digital  washout  (high- 
pass)  filter  in  the  yaw  rate  loop  was  implemented  as  a recursive  soft- 
ware algorithm  in  the  microprocessor.  To  insure  numerical  stability  and 
desired  performance,  a frequency  response  test  of  the  filter  was  accom- 
plished. Sinusoids  of  varying  frequencies  were  input  to  the  filter,  and 
output  responses  were  recorded.  Figure  7~3  gives  the  strip-chart  results. 
Inputs  are  shown  on  the  top,  and  outputs  on  the  bottom  of  each  run.  Sam- 
pling frequency  and  the  filter  equations  are  based  upon  fg  = 50  HZ.  Note 
that  high-pass  filtering  is  shown  by  the  characteristic  attenuation  of 
the  input  sinusoidal  amplitudes  as  frequencies  decrease  past  the  cutoff 
point,  fc  = .25  HZ  (1.57  rad/sec).  This  experimental  cutoff  frequency 
represents  a 12%  difference  when  compared  to  the  infinite  word  length 
digital  filter,  fc,  in  chapter  IV  (fc  = 1.4  rad/sec).  This  difference 
can  be  attributed  to  the  effects  of  sixteen-bit  word  length  arithmetic 
and  possible  errors  in  the  recording  equipment.  Although  not  shown,  phase 
coherence  is  also  preserved. 

Filter  responses  to  input  square-waves  were  also  done  in  a similar 
manner.  Results  are  shown  in  fig.  l~k.  Filter  performance  is  again 
demonstrated  by  noting  that  high  frequency  rise  time  components  pass 
through  the  filter  unattenuated,  whereas  the  DC  plateaus  of  the  square- 


Figure  7~3:  Frequency  Response  of  Digital  Filter  (Sinusoid) 
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Digital  Versus  Analog  Autopilot  Testing  Results.  The  primary  means 
of  determining  digital  A/P  performance  is  through  a qualitative  compari- 
son of  the  time  responses  generated  by  each  A/P  (simulated  analog  versus 
digital).  If  similar  performance  characteristics  are  obtained,  the  ob- 
jective of  this  study  is  met:  to  design  a digital  A/P  capable  of  emula- 
ting the  analog  A/P.  The  analog  A/P  is  represented  on  a hybrid  simulator 
as  a non-linear  6D0F  model.  Comparison  with  the  actual  flying  A/P  cannot 
be  made  at  this  time.  The  following  is  a summary  of  test  results: 

Pitch  Attitude  Controller.  Figs.  7"5  and  7*6  present  the  analog  and 

digital  A/P  responses,  respectively,  to  a 20  degree  step  pitch  up  command 

(0C) . The  primary  outputs  of  interest,  pitch  attitude  (6),  pitch  rate 

(5),  angle  of  attack  (a),  and  elevator  deflection  (6  ) show  excellent  re- 

e 

production.  Both  A/P's  achieve  the  commanded  20  degree  pitch  angle  in 
roughly  the  same  time.  Both  drift  down  to  the  12  degree  steady-state 
attitude  similarly.  The  digital  A/P  does  appear  to  be  somewhat  less  damped 
in  the  transient  response,  more  so  in  0.  This  may  be  attributed  to  quan- 
tization effects  in  the  control  software.  Overall  performance  of  this 
controller  is  quite  comparable.  No  deleterious  effects  are  noted. 

Roll  Attitude  Controller.  Figs.  7~7  and  7~8  provide  the  test  re- 
sults of  the  roll  attitude  controller  to  a 20  degree  step  roll  right  com- 
mand (<f>c) . The  primary  outputs  of  interest  are  roll  angle  (<f>) , roll  rate 

($) , sideslip  angle  (0),  and  aileron  deflection  (6  ).  Secondary  coupled 

d 

axis  outputs  include  yaw  angle  (4>) , and  yaw  rate  (^) . A comparison  of 

the  two  A/P  responses  in  4>  reveals  nearly  identical  waveshapes,  both  in 

the  transient  and  steady-state.  The  digital  $ and  6 responses  show 
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0 (deg/sec)  0 


RPV  Response  to  20  Degree  Step  Pitch  Up  Command (0c) 
Pitch  Attitude/Rate  Loops  Closed;  Analog  Controller 


Figure  7-5 
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Figure  7"6  : RPV  Response  to  20  Degree  Step  Pitch  Up  Command(0  ) 
Pitch  Attitude/Rate  Loops  Closed;  Digital  Control^e 
Engaged;  f =50  Hz 


■ 

r:;  ! : ! 

■ 

i 1 ! ' 

• ! j: 

.;!  i:i 

•|  ! • 

_ L.  ....i;  LU. 

llL 

L — _L. — i — - d — 1 

.1  jj 

: ;•  i 

. 

• 

j 

1 

■ : 

‘“1 

1 

. i 

LiiiLi. 

y 

iliiUliiliiliJLuaL 


.OljhiuililiJiiliJUJi 


iiiilllu. 


$ (deg/sec)  0 


i-U-L! 


RPV  Response  to  20  Degree  Step  Roll  Right  Command(<{>) 
Roll  Attitude/Rate  Loops  Closed;  Analog  Control ler  c 


Figure  7-7 
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Figure  7-7  : Continued  (Analog  Lateral  Controller  Engaged) 
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RPV  Response  to  20  Degree  Step  Roll  Right  Command (<J>c) 
Roll  Attitude/Rate  Loops  Closed;  Digital  Controller 
Engaged;  fs=50  Hz 


Figure  7-8 
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slightly  increased,  but  not  excessive,  rippling  after  1.5  seconds. 

Again,  finite  wordlenglh  and  quantization  effects  are  dominant.  Per- 
formance, however,  is  not  degraded  due  to  the  small  peak-to-peak  ampli- 
tudes of  the  oscillations.  These  similar  oscillations  are  noted  in 
digital  ip  but  are  no  problem.  Results  for  this  controller  show  good 
reproduci bi 1 i ty. 

Yaw  Rate  Controller.  Figs.  7~9  and  7~ 1 0 illustrate  the  resulting 

responses  of  the  yaw  rate  controller  to  a “3.3  deg/sec  step  yaw  rate 
• • 

command  (ij>  ) . Primary  outputs  include  \p,  ip,  $ and  rudder  deflection 

• • 

(<5r).  Secondary  cross-coupling  outputs  include  <f>,  <p,  and  6 . ip,  \p 

• a 

and  8 responses  for  both  A/P's  are  nearly  identical.  \J)  is  shown  to 
achieve  the  commanded  yaw  rate  in  the  steady-state  for  both  A/P's.  A 
slight  aberration  is  noted  in  the  transient  response  of  the  digital 
rudder  output  (S  ) , but  this  should  not  be  a problem. 

A comparison  of  cross-coupling  outputs,  especially  in  roll  rate 
(<J>)  and  aileron  deflection  (6  ) yield  what  first  appears  to  be  poor  cor- 
relation.  The  digital  outputs  of  4>  and  6 are  shown  to  go  into  sus- 
tained  steady-state  oscillations.  At  first  glance,  this  behavior  is 
unacceptable.  On  closer  scrutiny,  however,  the  results  are  acceptable. 
The  peak-to-peak  magnitudes  of  the  oscillations  are  smaller  than  the 
resolution  of  the  rate  sensors  and  actuators.  Thus,  the  RPV  would  not 
see  these  effects.  Quantization  and  limit  cycling  may  contribute  to  this 
phenomena.  For  simulation  purposes,  the  yaw  rate  input  to  the  rudder 
produces  a cross-coupled  sustained  aileron  (6 _ ) oscillation  of  about  0.3 
degrees.  This  is  almost  unnoticeable.  When  the  digital  A/P  was  flown  on 
the  manual  control  station,  the  oscillations  could  not  be  detected  in  any 
manner. 
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RPV  Response  to  3.3  Deg/Sec  Step  Yaw  Rate  Command^ 
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Engaged  (Yaw  Damper) 


ill » 
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Figure  7-9  : Continued  ( Analog  Yaw  Damper  Engaged) 


Figure7-10  : RPV  Response  to  3*3  Deg/Sec  Step  Yaw  Rate  Command (^); 

»■  Yaw  Rate/Accelerometer  Loops  Closed  ; Digital  Controller 

Engaged  (Yaw  Damper);  f =50  Hz 


i 


Figure7"10  : Continued  ( Digital  Yaw  Damper  Engaged;  f =50  Hz) 


In  general,  digital  yaw  rate  controller  performance  is,  again,  quite 
comparable  to  the  analog  controller.  No  instabilities  or  potential  prob- 


lem  areas  exist. 

Digital  Controller  Performance  Versus  Sampling  Frequency  Test  Results 
The  next  logical  course  of  action  was  a test  of  digital  controller 
performance  as  a function  of  sampling  frequency  (fg).  This  brief  analysis 
allows  the  determination  of  a range  of  potential  sampling  frequencies,  and 
insures  that  the  one  chosen  for  final  controller  implementation  will  not 
induce  instabilities  in  the  system. 

Pitch  Attitude  Controller.  This  section  presents  the  four  primary 
pitch  attitude  controller  outputs  as  a function  of  fg.  These  include  4> 

(fig.  7-11),  $ (fig.  7-12),  a (fig.  7-13)  and  (fig.  7-14).  Five 
sampling  frequencies  are  considered:  30  HZ,  10  HZ,  5 HZ,  3 HZ,  and  1 HZ. 

A 20  degree  step  pitch  up  forcing  function  is  commanded  (0C). 

Results  clearly  show  that  as  the  f decreases  to  about  2.5  HZ  to 
3 HZ,  successive  time  response  degradation  ensues.  The  controller,  how- 
ever, is  still  stable  but  progressively  slow  and  undamped.  Below  2.5  HZ 
the  controller  appears  to  go  unstable  for  all  four  variables.  At  1 HZ, 
the  elevators  (6g)  are  shown  to  be  oscillating  and  control  is  destroyed. 

Based  upon  this  graphic  aralysis,  it  is  not  inconceivable  that  the  fs  can 
be  decreased  to  as  low  as  5 HZ.  Other  digital  controllers  referenced  in 
the  literature  have  used  sampling  frequencies  as  low  as  10  HZ. 

Roll  Attitude  Controller.  A similar  analysis  is  made  for  the  roll 
rate  controller.  Outputs  include  <f>  (fig.  7“  15)*  (fig.  7“  1 6) , 0 (fig. 

7-17),  and  6g  (fig.  7-18)  for  the  following  f$:  30  HZ,  10  HZ,  5 HZ.  A 

brief  inspection,  again,  reveals  progressive  performance  degradation  as 
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fg  decreases.  The  controller  goes  unstable  at  about  1.5  HZ  (not  shown). 

Roll  attitude  ($)  and  sideslip  (0)  are  quite  stable  for  all  three  cases. 

Rapid  undamping  and  attendant  steady-state  oscillations  appear  for  roll 

rate  (<f>)  and  aileron  deflection  (6  ).as  f decreases.  Because  the  system 

3 ^ 

is  still  stable  above  1.5  HZ,  these  tradeoffs  may  have  to  be  acceptable 
if  fs  is  required  to  decrease  from  its  present  value,  fg  = 50  HZ. 

Yaw  Rate  Controller.  A test  of  the  yaw  rate  controller  was  made  for 
several  fg,  but  not  recorded.  Results  were  in  agreement  with  the  two 
controllers  above. 

Overall  Evaluation 

This  chapter  has  succeeded  in  establishing  basic  digital  A/P  testing 
procedures  and  the  results  of  comparative  simulation  time  response  test- 
ing. Digital  A/P  performance  has  been  shown  to  be  very  similar  to  that 
of  the  analog  A/P.  Hence,  a major  requirement  of  this  study  has  been  sat- 
isfied with  assurance.  Differences  in  system  performance,  not  unexpected ly, 
can  be  attributed  to  such  parameters  as  finite  wordlength,  noise,  limit 
cycl ing,  etc. 
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Pitch  Attitude(9)  Response  to  20  Degree  Step  Pitch 
Up  Command (0c)  Versus  Sampling  Frequency ( f s ) ; Full 
Digital  Controller  Engaged 


Figure  7-1 1 
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Figure  7“ 12:  Pitch  Rate(9)  Response  to  20  Degree  Step  Pitch  Up 
Command(0  ) Versus  Sampling  Frequency(f  );  Full 
Digital  cSntroller  Engaged  s 
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Figure  7-13 


Angle  of  Attack(a)  Response  to  20  Degree  Step  Pitch 
Up  Command(0  ) ''ersus  Sampling  Frequency (f  );  Full 
Digital  Controller  Engaged 
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Elevator  Deflection(8  ) Response  to  20  Degree  Step 
Pitch  Up  Command(0  ) Versus  Sampling  Frequency (fs) 
Full  Digital  Controller  Engaged 


Figure  7_l4 


Figure  7“  1 5 


Roll  Att i tude (<(>)  Response  to  20  Degree  Step  Roll 
Right  Command  (<J>C)  Versus  Sampling  Frequencyff  ); 
Full  Digital  Controller  Engaged 
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Figure  7~  16:  Roll  Rate(<}>)  Response  to  20  Degree  Step  Roll  Right 
Command(<}>c)  Versus  Sampling  Frequency(f  );  Full 
Digital  Controller  Engaged 
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Figure  7~ 1 7 : Sideslip  Angle(8)  Response  to  20  Degree  Step  Roll 
Right  Command (4>  ) Versus  Sampling  Frequency(f  ); 
Full  Digital  Controller  Engaged  s 


Aileron  Def lection(6a)  Response  to  20  Degree  Step 
Roll  Right  Command (<J>)  Versus  Sampling  Frequency 
(f  )i  Full  Digi  tal  cSntroller  Engaged 


Figure  7“  18 
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VIII.  Conclusions  and  Recommendations 


A low-cost  microprocessor-based  digital  A/P  for  the  XBQM-106  Mini- 
RPV  has  been  constructed  in  breadboard  form,  and  its  performance  shown 
to  be  comparable  to  the  existing  analog  A/P.  Although  no  cost  analysis 
has  been  performed,  the  hardware  costs  are  quite  modest  since  all  com- 
ponents are  quite  inexpensive  (and  should  become  even  more  so  in  the 
future).  Thus,  it  appears  that  a low-cost  microprocessor-based  A/P  is 
feasible. 

As  a by-product,  three  unanticipated  beneficial  results  were  real- 
ized. First,  several  errors  in  the  hybrid  simulation  were  corrected 
when  its  response  failed  to  agree  with  the  digital  A/P.  Second,  a 
washout  (high-pass)  filter  in  the  pitch  axis  of  the  existing  analog  A/P 
was  removed  when  control  analysis  showed  its  effects  to  be  detrimental 
to  system  performance.  Third,  the  pendulum  sensor  in  the  yaw  axis  was 
removed  when  simulation  results  showed  it  to  be  of  questionable  value. 

This  investigation  also  revealed  several  additional  items  that  might 
prove  beneficial  to  the  RPV  program.  First,  there  are  no  performance 
specifications  existing  within  the  program.  Although  probably  not  needed 
in  the  earlier  stages  of  the  program,  the  more  sophisticated  nature  of 
future  developments  would  surely  benefit  by  a formal  definition  of  system 
requirements.  Second,  the  servo  actuators  are  the  primary  limitation  to 
improved  control  system  performance.  Although  their  ultra-low  cost  makes 
them  an  excellent  choice  for  the  system  as  it  is  used  now,  any  required 
improvement  in  control  system  performance  will  have  to  investigate  meth- 
ods of  improving  actuator  characteristics.  These  might  include  replace- 
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ment,  redesign,  addition  of  compensators,  etc. 

Since  this  project  is  basically  a feasibility  study,  additional 
work  needs  to  be  completed  before  a practical  digital  A/P  is  realized. 
The  following  items  have  been  identified  as  areas  which  need  additional 
consideration,  and  as  such,  would  be  suitable  for  follow-on  study: 


- — Improve  performance  of  the  present  design  by  operating  the 
A/D  converter  and  microprocessor  at  maximum  speeds 

- — Construct  a flight  testable  version  of  the  present  bread- 
board digital  A/P 

Incorporate  additional  functions  (such  as  altitude  hold  and 

heading  holding)  into  the  digital  A/P  as  they  are  incorpor- 
ated into  the  analog  A/P 

Incorporate  additional  functions  into  the  digital  A/P  that 

are  not  included  in  the  analog  A/P  (such  as  failsafe,  mixer, 
etc.) 

Investigate  algorithm  synthesis  for  pre-programmed  mission 

profiles  (such  as  loiter  patterns) 

Investigate  the  interfacing  of  seeker  guidance  control  loops 

into  the  A/P 

Improve  processor  capability  by  replacing  the  CDP-1802  micro- 
processor with  the  new  upward  compatible  CDP-1801*  microprocessor 

Monitor  sixteen-bit  microprocessor  developments  (particular- 
ly cost  and  peripheral  chip  costs)  to  determine  if  a low- 
cost  digital  A/P  can  be  built  using  this  technology.  Ob- 
viously, this  is  useful  only  if  capabilities  can  be  obtained 
that  are  not  realizable  with  an  eight-bit  processor 

—Perform  a sampled-data  control  system  analysis. 

In  conclusion,  the  twin  objectives  of  this  study  have  been  met  with 
success.  First,  a linear  control  model  for  the  analog  A/P  has  been  dev- 
eloped.  Thus,  future  RPV  performance  criteria  can  be.  investigated  mathe- 
matically rather  than  by  present  "hit  or  miss"  methods.  Secondly,  a 
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Appendix  A 


The  purpose  of  this  appendix  is  to  augment  the  discussion  in 
Chapter  II  concerning  RPV  transfer  functions.  In  particular,  this 
section  includes  the  following: 

— Transfer  function  derivation 

— Transfer  function  listings:  tables  A-12  ~ A-13a,b 
— Transfer  function  frequency  responses:  fig.  A- la  ~ A- 11 
— Transfer  function  time  responses:  fig.  A-12a  ~ A-27b 
— Transfer  function  root  loci:  fig.  A-28a  ~ A-41 

—Free  RPV  airframe  responses  (hybrid  simulation):  fig.  A-42  ~ A-49 

Derivation  of  Linear  XBQM-lOb  RPV  Transfer  Functions 

A complete  control  analysis  of  the  longitudinal  and  lateral-direc- 
tioral  axes  requires  that  the  aircraft  transfer  functions  be  known. 

An  interactive  computer  program,  the  AFFDL  McGlynn  program  (1973) , is 
used  via  INTERCOM,  to  derive  the  representative  transfer  functions  for 
three  flight  conditions  (Ref:31): 


Altitude  (ft.msl*) Weight  (lb) Mach 


Case  1 

1000 

135 

.125 

Case  1 1 

3000 

135 

.125 

Case  1 1 1 

6000 

135 

.125 

* Mean  Sea  Level 

Program  inputs  consist  of  desired  flight  case  parameters  and  aerodynamics 
data.  Laplace  transfer  functions  are  generated  as  program  output.  Aero- 
dynamic data  called  for  in  the  program  is  extracted  from  current  wind 
tunnel  data  provided  by  the  Mini-RPV  Group/AFFDL  (Ref:39).  "Standard" 
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control  surface  deflection  notation  is  used  to  insure  proper  sign 


convention  of  the  input  data  (see  fig.  2-3,  Chap.  II).  Each  re- 
quested output  transfer  function  (for  Case  II  only)  is  listed  in  both 
standard  (root  locus)  and  alternate  (Bode)  form  in  Tables  A-12  and 
A- 13-  The  AFFDL  McGlynn  program  consists  of  two  subprograms:  TTYLON 
(longitudinal  axis),  and  TTYLAT  (lateral  axis). 

TTYLON 

TTYLON  calculates  either  the  full  longitudinal  axis  (phugoid  and 
short-period)  transfer  functions  or  the  short-period  approximation 
transfer  functions.  This  study  deals  with  only  the  full  transfer  func- 
tions. Input  parameters  consist  of  specified  non-dimensional  stability 
derivatives  and  RPV  constants  (flight  case  parameters).  The  input  aero 
data  is  the  same  for  all  three  cases  and  is  listed  in  Table  A-l.  Inter- 
mediate output  data,  depicted  in  Tables  A-2,  A-3,  and  A-4  shows  the 
following  information: 

— Flight  case  data  - echo  of  input  constants 

— Non-dimensional  derivative  matrix  - "trim-conditioned"  deriva- 
tives calculated  for  Table  A-1 

— Dimensional  derivative  parameter  matrix  - body  axes  derivatives 
calculated  from  non-dimensional  derivative  matrix 

TTYLAT 

TTYLAT  calculates  both  the  roll  and  yaw  axis  transfer  functions. 
Input  aero  data  is  the  same  for  all  three  cases  and  is  listed  as  a 
non-ditnensional  derivative  matrix  in  Tables  A-5,  A-6,  and  A~7.  These 
three  tables  also  present  the  following  information: 
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— Flight  case  data  - echo  of  input  constants 
— Non-dimensional  derivative  matrix  - echo  of  input  aero  data 
— Dimensional  derivative  parameter  matrix  - body  axes  derivatives 


calculated  from  non-dimensional  derivative  matrix 

Once  the  required  input  data  is  entered  interactively  into  either  pro- 
gram, the  desired  transfer  functions  are  chosen  from  a menu  of  avail- 
able options.  The  resulting  transfer  functions  are  then  calculated  in 
both  polynomial  and  factored  form. 

Linear  Longitudinal  Equations 

A brief  description  of  the  longitudinal  transfer  function  deriva- 
tion is  essential  to  an  understanding  of  the  linearization  process 
involved.  McGlynn  (Ref:30;3l)  describes  the  linear  longitudinal  equa- 
tions of  motion  in  body  axes  as  follows: 

AX  + AT  COS  eT  = m(y  + W q + 0 COS  6 ) 

I o g o 

AZ  - AT  SIN  e = m(U  a - U a + 6 SIN  0 ) 

T o o g O 

AM  + AT  ZT  COS  eT  = lyyq 
0 = q 

Variable  and  coefficient  definitions  are  listed  in  (Ref:30).  These 
equations  are  transformed  into  a standard  perturbation  matrix  model  of 
the  form 

: A X = B U 

which  relates  forward  velocity  (U) , angle  of  attack  (a),  pitch  rate  (q) , 
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and  pitch  attitude  (0)  to  elevator  displacement  (6e)  and  thrust  (T). 
The  model  is  expressed  in  Laplace  form  by: 


A X B U 


(1-X*)S-XU 

-x • s-x 

a a 

w-x 

o q 

gCOS0 

o 

U 

iC0SeT  | 
X.  » 

j 

6 

e 

-ZGS-Zu 

(u  -z:)s-z 

o a a 

-U  -Z 

o q 

gSIN0o 

a 

. • SINgt 

z6  i“— — L 

6 m 

i 

AT 

-M • S-M 

-M* S-M 

S-M 

0 

q 

= 

Mr  !ZTC0SeT 

u u 

a a 

q 

c 

fl> 

0 

0 

-1 

S 

0 

"i 

o 

o 

1 

The  body  axes  dimensional  derivative  parameters  used  in  this  matrix 
(eg.  Xu,  Xx)  are  derived  in  the  program  by  manipulation  of  the  equations 
presented  in  Tables  A-8  and  A-9.  Conversion  equations  in  Table  A-9  re- 
quire a program  calculated  trim  angle  of  attack  which  is  not  supplied 
as  an  input  parameter.  Solution  of  the  perturbation  matrix  for  specific 
transfer  functions  (eg.  0/ 6e , 0/6e)  follows  the  conventional  Cramer's 
Rule  technique  (Ref : U;  1 7 ; 2 1 ;30;31  ;32;1*2) . 


Linear  Lateral  Equations 

From  (Ref : 30 ; 31 ) , the  set  of  linear  lateral  equations  of  motion 
(body  axes)  is  described  by: 

AY  = m(VT6  - WqP  + UQr  - <f>gC0S6o) 

AL  = I p - I r 
XX  xz 

d)  = p + rtan© 

o 

tp  «=  r/COS0 
T o 
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in  the  program  by  manipulations  presented  in  Tables  A-10  and  A— 11.  Matrix 
solution  for  desired  transfer  functions  is  accomplished,  again,  via  Cramer's 
Rule  (Ref:l»;17;21;30;31;32;i»2). 

Transfer  Functions 

Table  A-12  includes  longitudinal  transfer  functions  for  pitch  at- 
titude  (6),  pitch  rate  (0),  angle  of  attack  (a)  end  forward  velocity  (U, 
rad/sec)  related  to  elevator  deflection  (<$g) . It  is  important  to  note 
that  both  the  phugoid  and  short-period  modes  are  incorporated  in  the 
equations  (Ref  4:35). 

Table  A— 1 3 includes  the  more  common  latera 1 -d i rect ional  (roll  and 

yaw)  transfer  functions.  Roll  (<t>) , roll  rate  (<Ji)  , yaw  (^) , yaw  rate 

(ip) , and  sideslip  (B)  are  expressed  relative  to  both  aileron  deflection 

(6  ) and  rudder  deflection  (6  ).  Roll  subsidence,  spiral  divergence, 

9 r 

and  dutch  roll  factors  are  implicit  in  the  functions  (Ref  4:ll8).  Three 
flight  cases  are  described. 
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Frequency  Responses 

The  following  transfer  function  frequency  responses  are  depicted 
for  each  axis: 


Pitch  : 

fig.  A-la  ~ A-3b 

Roll  : 

fig.  A-4a  ~ A-7 

Yaw  : 

fig.  A-8a  ~ A-l 1 

Note  that  frequency  responses  are  also  shown  with  the  actuator  servo 
multiplied  by  the  basic  transfer  function.  These  can  be  used  directly 
to  determine  system  gain  and  bandwidth  in  the  forward  loop. 

Time  Responses 

The  following  transfer  function  time  responses  to  selected  forcing 
functions  are  shown  for  each  axis: 

Pitch  : fig.  A-12a  - A-l6b 

Roll  : fig.  A-17a  - A-20 

Yaw  : fig.  A-21a  ~ A-27b 

Again,  actuator  responses  are  included. 

Root  Loci 

The  following  transfer  function  root  loci  are  depicted  for  each 

axis: 

Pitch  : fig.  A-28a  ~ A-33b 

Roll  : fig.  A-3^a  ~ A-37 

. Yaw  : fig.  A-38a  ~ A-Al 


Note  that  magnified  loci  are  shown  for  selected  functions  so  as  to  aid 

in  analysis.  Actuator  inclusions  are  especially  helpful  in  showing  loci 
branching  effects. 
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Free  RPV  Airframe  Responses 


The  following  time  responses  are  shown  for  similar  forcing  functions 


used  in  fig.  A-12a  ~ A-27b: 


Pitch 


fig.  A-42  ~ A-43 
fig.  A-44  ~ A-45 
fig.  A-46  ~ A-49 


These  strip  chart  recordings  were  generated  from  a six  degree-of “freedom 
(6D0F)  non-linear  RPV  model  on  hybrid  simulation. 


► 


Table  A-l 


Longitudinal  Axis 

Input  Aero  Data  (Cases  1 

. II.  IN) 

Mnemon i c* 

Value 

Units 

MACH 

0.125 

— 

CL  (A0A=0) 

0.340 

— 

f 

CLA 

0.094 

per  deg 

CLDE 

0.012 

per  deg 

fc. 

► 

fc- 

r- 

CLQ 

7.0 

per  rad 

CLAD 

1.15 

per  rad 

f 

CLMAX 

1.2 

— 

I 

u 

CM  (A0A=0) 

-0.06 

— 

1 

CMA 

-0.03 

per  deg 

CMDE  (AOA) 

-0.043 

per  deg 

1 

i 

CMQ 

-17. 

per  rad 

CMAD 

-4. 

per  rad 

1 . 

CDMIN 

0.048 

— 

4 

CL  (CDMIN) 

0.18 

— 

' 

KCL2 

0.0565 

— 

s 

j- 

DEMIN 

0. 

deg 

■ 

r 

KDE2 

0. 

per  deg 

f 

1 

TMAX 

50. 

lbs 

i 
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Table  A-2 


Case  I (Longitudinal  Axis) 


FI ight  Case  Data 


MACH  * .12500 

y FPS*  • 

139.30 

WSND*  * 1114.37 

ALT  • 1000. 

QDYN*  * 

22.39 

DEN*  * .0023080 

WGHT  • 135. 

IYY 

25. 

AREA  • 18.18 

CG  • 5.420 

REFCG  * 

5.420 

CHORD  * 1.65 

GAMMA*  • 0.000 

EPSTH  ‘ 

0.000 

ZT  • -.798 

AOA*  • .165 

ELEV*  • 

-2.002 

THRST*  • 20.07 

Non-Dimensional 

Derivative  Matrix 

Perturbation 

CD 

CL 

CM 

0 (per  rad) 

,04929653 

.33148420 

.02115278 

M (per  rad) 

0.00000000 

0.00000000 

0.00000000 

A (per  deg) 

.00160907 

.09400000 

-.03000000 

AD  (per  rad) 

0.00000000 

1.15000000 

-4.00000000 

Q (per  rad) 

0.00000000 

7.00000000 

-17.00000000 

DE  (per  deg) 

.00020541 

.01200000 

-.04300000 

Dimensional  Derivative  Parameter  Matr 

ix* 

Perturbation 

X 

Z 

M 

U (per  rad) 

-.67850E-01 

-.45105E+00 

.8941 i E-02 

UD  (per  rad) 

-.39358E-07 

. 13664E-04 

. 1291 1 E-04 

A (per  rad) 

.24707E+02 

-.52742E+03 

-.45298E+02 

AD  (per  rad) 

.190336-02 

-.66079E+00 

-.62437E+00 

Q (per  rad) 

. 1 1 586E-01 

-.40222E+01 

-.26536E+01 

DE  (per  rad) 

-.94970E+00 

-.66708E+02 

-.64932E+02 

* Internally  Calculated 


Table  A-3 

Case  II  (Longitudinal  Axis) 


FI ight  Case  Data 
MACH  * . 1 2500 

VFPS* 

138.33 

VSND* 

• 1106.63 

ALT  * 3000. 

QDYN* 

20.81 

DEN* 

• .0021749 

WGHT  • 135. 

IYY 

25. 

AREA 

18.18 

CG  • 5.^20 

REFCG 

5.420 

CHORD 

• 1.65 

GAMMA*  • 0.000 

EPSTH 

0.000 

ZT 

• -.708 

AOA*  • .457 

ELEV* 

-2.211 

THRST* 

• 18.82 

Non-Dimensional  Der' 
Perturbation 

vative  Matrix 

CD 

CL 

CM 

0 (per  rad) 

.04975951 

.35647010 

.02135203 

M (per  rad) 

0.00000000 

0.00000000 

0.00000000 

A (per  deg) 

.00187447 

.09400000 

-.03000000 

AD  (per  rad) 

0.00000000 

1.15000000 

-4.00000000 

Q (per  rad) 

0.00000000 

7.00000000 

-17.00000000 

DE  (per  deg) 

.00023929 

.01200000 

-.04300000 

Dimensional  Derivative  Matrix* 
Perturbation  X 

z 

M 

U (per  rad) 

-.62670E-01 

-.43688E+00 

•99904E-02 

UD  (per  rad) 

-.28498E-06 

. 35691 E-04 

.33724E-04 

A (per  rad) 

.26298E+02 

-.49034E+03 

-.42086E+02 

AD  (per  rad) 

.49369E-02 

-.61830E+00 

-.58423E+00 

Q (per  rad) 

•30053E-01 

-.37638E+01 

-.24831E+01 

DE  (per  rad) 

-.741 12E+00 

'.61995E+02 

-.60339E+02 

*lnternally  Calculated 
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Table  A-4 

Case  111  (Longitudinal  Axis) 


FI ight  Case  Data 


MACH 

12500 

VFPS* 

136.86 

VSND* 

• 1094.91 

ALT 

6000. 

QDYN* 

18.60 

DEN* 

• .0019863 

WGHT 

135. 

IYY 

25. 

AREA 

* 18.18 

CG 

5.^20 

REFCG 

5.420 

CHORD 

* 1.65 

GAMMA*  • 

0.000 

EPSTH 

0.000 

ZT 

• -.708 

AOA* 

.948 

ELEV* 

-2.562 

THRST* 

17.15 

Non-Dimensional  Derivative  Matrix 

Perturbation 

CD 

CL 

CM 

0 (per  rad) 

.05069293 

.39831758 

.02175485 

M (per  rad) 

0.00000000 

0.00000000 

0.00000000 

A (per  deg) 

.00231897 

.09400000 

-.03000000 

AD  (per  rad) 

0.00000000 

1.15000000 

-4.00000000 

Q.  (per  rad) 

0.00000000 

7.00000000 

-17.00000000 

DE  (per  deg) 

.00029604 

.01200000 

-.04300000 

Dimensional  1 

Derivative  Parameter 

Matrix* 

Perturbation 

X 

Z 

M 

U (per  rad) 

-.55397E-01 

-.41714E+00 

. 1 1 507E-O1 

UD  (per  rad) 

-.1 1 164E-05 

.67502E-04 

.63789E-04 

A (per  rad) 

.28515E+02 

-.43874E+03 

-.37611E+02 

AD  (per  rad) 

.92373E-02 

-.55853E+00 

-. 52781 E+00 

Q (p&r  rad) 

. 56242E-01 

-.34007E+01 

-.22438E+01 

DE  (per  rad) 

E f 

1 1 

-.45057E+00 

-.55435E+02 

-•53947E+02 

k.  * 


Table  A-5 


Case  I (Lateral  Axis) 


Flight  Case  Data 


MACH 

.12500 

ALT 

1000.  WGHT 

135- 

AOA 

0.00 

SPAN 

11.17  AREA 

• 18.18 

IXX 

9. 

IZZ 

32.  IXZ 

• -2. 

QDYN*  • 

22.39 

VFPS*  • 

139.30  DEN* 

• .0023080 

Non-Dimensional  Derivative  Matrix 

Perturbation 

CY 

CL 

CN 

B (per  deg) 

-.01800000 

-.00060000 

.00290000 

P (per  rad) 

0.00000000 

-.1*5600000 

-.02600000 

R (per  rad) 

,75000000 

.07500000 

-.35000000 

BD  (per  rad) 

0.00000000 

0.00000000 

0.00000000 

DA  (per  deg) 

.00180000 

.00420000 

-.00021000 

DR  (per  deg) 

.00265000 

.00015000 

-.00135000 

Dimensional  1 

Derivati 

ive  Parameter 

Matrix* 

Perturbation 

Y 

L 

N 

B (per  rad) 

-.10006E+03 

-.17113E+02 

.23291 E+02 

P (per  rad) 

0. 

-.90989E+01 

-.  1 1238E+00 

R (per  rad) 

.29167E+01 

.14965E+01 

-. 19666E+01 

BD  (per  rad) 

0. 

0. 

0. 

DA  (per  rad) 

. 10006E+02 

.11979E+03 

-.16866E+01 

DR  (per  rad) 

.1 A731 E+02 

.42783E+01 

-.10843F.+02 

* Internally  Calculated 
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Table  A-6 

Case  I I (Lateral  Axis) 


MACH 

.12500 

ALT 

3000.  WGHT 

135. 

AOA 

0.00 

SPAN 

11.17  area 

18.18 

IXX 

9. 

IZZ 

32.  IXZ 

• -2. 

QDYN*  • 

20.81 

VFPS*  * 

138.33  den* 

• .002171*9 

Non-Dimensional  Derivative  Matrix 

Perturbation 

CY 

CL 

CN 

B (per  deg) 

-.01800000 

-.00060000 

.00290000 

P (per  rad) 

0.00000000 

-. ^5600000 

-.02000000 

R (per  rad) 

.75000000 

.07500000 

-.35000000 

BD  (per  rad) 

0.00000000 

0.00000000 

0.00000000 

DA  (per  deg) 

.00180000 

.001*20000 

-.00021000 

DR  (per  deg) 

.00265000 

.00015000 

-.00135000 

Dimensional  1 

Deri  vat 

ive  Parameter  1 

Matrix* 

Perturbation 

Y 

L 

N 

B (per  rad) 

-. 92981 E+02 

-.15903E+02 

.2l6i*1*E+02 

P (per  rad) 

0. 

- . 851 1+5E-+-0 1 

-.10516E+00 

R (per  rad) 

.27293E+01 

. 1 l*00l*E+01 

-.18403E+01 

BD  (per  rad) 

0. 

0. 

0. 

DA  (per  rad) 

.92981 E+01 

.111 32E+03 

-.15673E+01 

DR  (per  rad) 

. 1 3689E+02 

.39757E+01 

-.10076E+02 

Table 

A-7 

Case  1 1 1 (Lateral 

Axis) 

Flight  Case  Data 

MACH  • .12500 

ALT 

6000.  WGHT 

• 135. 

AOA  • 0.00 

SPAN 

11.17  AREA 

• 18.18 

IXX  • 9. 

IZ2 

32.  IXZ 

-2. 

QDYN*  • 18.60 

VFPS*  • 

136.86  DEN* 

• .0019863 

i 

Non-Dimensional  Derivative  Matrix 

Perturbation 

CY 

CL 

CN 

B (per  deg) 

-.01800000 

-.00060000 

.00290000 

i 

P (per  rad) 

0.00000000 

-.1*5600000 

-.02000000 

1- 

R (per  rad) 

.75000000 

.07500000 

-.35000000 

r 

BD  (per  rad) 

0.00000000 

0.00000000 

0.00000000 

DA  (per  deg) 

.00180000 

.001*20000 

-.00021000 

t 

DR  (per  deg) 

.00265000 

.00015000 

-.00135000 

Dimensional  Derivative  Parameter  Matrix* 

Perturbation 

Y 

L 

N 

B (per  rad) 

-.831 30E+02 

— . 1 1*2 1 8E+02 

. 19351 E+02 

P (per  rad) 

0. 

-.76939E+01 

-.95023E-01 

R (per  rad) 

.24663E+01 

. 1 265-4E+01 

-.16629E+01 

| 

BD  (per  rad) 

0. 

0. 

0. 

DA  (per  rad) 

.83130E+01 

.99525E+02 

— .1 1*01 3E+01 

i 

DR  (per  rad) 

. 12239E+02 

.355l*5E+01 

-. 90082 E+01 

i 

: 

» 

li 


i 

t 


t 


. t 

| 


* 


Table  A-9 


Longitudinal  Stability  Axes  to  Body  Axes  Conversion 

XuZ  Xu  CoSZX  - ( X"  + 2'u)siH  X Cos*.  + 2#  S/A/2* 

Xw~  X#  ccs  2oc  + ( Xu-  it,,)  s/a/oc  cos  oc  - £'u  $/*/  2 X 

X%  = Xf  Cosot  - S/a/oC 
> 2 / 

Xy  — X " CoS  X — 2?  ft  S/aJ*  Cos  K 

XT  - Xr  cos  oc  — z S/A)  K 
de.  (T£ 

Zu=  CeS*0C  - ( 2,0-  Xu  ) S/A/K  cost*  - X*w  s/Ai*fiC 

- Z„  Cos  K -f  ( z U +-  X«/)  S/aJo(  Cosoc  + Xu  S/A)  Zo< 

Zo  CoS  OC  - X £ S'*)OC 

Zy  ~ 2 £,  Cos2*  +■  S/AJOC  Cosoc 

Zr  = B COSOC  + x'  S/AJOC 

0C>  oc.  &C. 

Mu  ~ Mol  CoS X - s/a t oc 

Mtf9  M#  Cosx  + Mu  s/a)  k 

Mi  e*SK. 

MtS  »k 


f.  I f 

' 

1 1 

Table  A-10 

■ 

Dimensional  Derivative  Parameters 
Laterai-Di rectional-Body  Axes 


t-W** 

V e“ 

* /?■£&'.*  c„ 

* * * 

yp=  /?s/r£>  cYp 
r 4m 

np - CV 

r 4 iz*. 

Yr*  Cyr 

r 4 m 

*rxx 

N * />5  YrAlCn^ 

4 Tlh 

y.  = % 

P 4 m 

/ • S ft  S Vy  b C.p  , 

fl  r4Z*<  fi 

Vi*  />S'/rh'Cn 

V 

2m 

Se^ia 

Hr*  '/fb  C”r, 

* Z?iZ 

V --  pSUTzCy 

/»•**>  *4  <Vr 

- P'S  Ur  b ^yj  _ 

,<r-  rT^  v- 

* rsr„  ^ 

*'  2Iit  *' 

Table  A-ll 


Lateral  Stability  Axes  to  Body  Axes  Conversion 


V 


C-yp  Cosot  - Cy^  <f/A)0t 
Cyp  SSAJCt  +-  Cj^  Cos  ot 


y- 

Cl  Cos  At  - c'  S/AJex^ 

4 t / 

C%p  C°S  ^ SftJ  *C  ~ +-  Cp^)s/*JK  Cost 

yi  ^ ^ /7  ^ 2 ^ ^ ^ / t 


= ^ ^ **  - ^ V ( <72 p ~ )s/»*c 


Cosot 


tSos  t — C"  . s/*>  fit 

t y V 

Vn  , V/* 

* Cf  Cost  - £ s,v  fit 

/r  f /* 

C - S/tSfit  -h  c'  Cost 

J J4  *4 


4 x >4  / 

" ^ 'Sr*JZt  t ( Cjp^  - C^^j$//ufit  cosot 

~ ^~t)r  ^ t-'X  f/AJ  l0C  +'  ( Cf  + C." pjstOJX.  CoS  * 

o'r  y r ^ 


- 9 ' SfA>  * + Cn  • * 

= ct^  S'u«  f ^ <**•« 

= s^ t r C^j.  cosot 


Note:  All  primed  coefficients  appear  as  input  data  in  the  program  TTYLAT, 


■ i ••  *-  =d^«Mfe—r ?ut— n i 


Table  A-13 


i 


Transfer 
Funct ion 

*(S)  PHI 

OsT'Ba- 


Lateral  RPV  Transfer  Functions 
Standard  form  Ro<ig  FP™ 


Casa 


/ S V 2(-271 ) _ 

(usa*  6.8896  S 1 


(121.09)  (Sl+2.6666S+23.9076)  (unM.OI)  |\6.8B9yT  ->  j(  „„ 

(s-. 00122 15)  (so., 9iTo(S',*2.)j#2s+iii.4:?iJ 

(irWf+  s*i) 


(U2.52)  (>;*2.li7t6S*22.  l686) 


TW12306)  (3+8. 6o59)(^+2.5$9«+».  1666) 


(10173.96) 


(rdW  -')(rlo59  +,)j^W+  onr4*'! 

(9931.36)  [(TO?!*  S+,j 

u::oSWiM(w:«s^2:30625+2o.t7t.y  ^ +,)L^+ 


" 


(100.6) (S?+2.2378S+19» 757*0  (9931 


III 


NOTE: 

i(S)/6a(S) 


Transfer 
Funct ion 

*(S)  PSI 

' OsT’  oa 


- ♦<S)/«i(S).  (S)  (PHID0T/0A) 

Standard  Form 

(7.5l<5)  (S-3.296)  (S2+7.6326s+25.865) 

(S-. 00122 15)  (S+9. 1961 ) (Si+2.7372S+2lt.9275)(S)  ^ 

(7.0113)  (S-3  259)  (S*+7.3176S+26.671Q 


Bode  Form 


Case 


( S A 1 * f + ?,(»7S)  $4-1  I 

(2297.6)\TT?9^  VLV5.06y  5.086 J — 

^ooTTIiT  M)  (rfW  SHfzT  *j 

(228i . 3) irk?-')  n 


(S-. 0012306) ($+8.6059) (S‘+2. 5592S+23. 1666) (S)  ./  5 

5\.  001 2306 


(228'.3)(rk-’)iy^l^r , 

')  tro59 +')  ^rin^  ♦onr  *4’ 


>6.2685) (S-3.202) ($l+6.8696s+22.508)  (2257.6)1 

MW” 

L 

(S-.OOI266) (S+7. 7809) (S:+2.3082S+20. 6761) (S) 

[001266 

-0(rw9 

Cl 


NOTE: 

i($)/6  (S) 


«|/(S)/6a(S)-(  S ) (PSIP0T/0A) 


Transfer 

Function 

g(S)  BETA 

T^TsT'  oa 


Standard  Form 


(.07183HS+ 1.1115)  (5+6.3575)  (S+106.5S)  (193.2)^TTTiT  *!)(&.  3575  *')  (l06.S~E  *’) 

(S-.  00122  15)  (S+9. 1961  HS-+2. 73725*26. 9275)  / S \(  S . ,\  U 5 Uj. 

I riMiViT  <1  \a  i ol.  i ♦'!  Hl  QQ?  7 1 6.99 


botW 


Utt 

i 


(.06722) (S+l .0833) (S+6. 1809) (S+105.67) 


m 

f s 1! 

if.?  .V 

1 S V 2 (.266) 
Yi.flll'l/  ♦A.Blll  *♦* 

'.001230^  j 

68.6059  V 

(. 06076)  (S»1  ■ 0323)  (5+5.9615)  (5*103 .83)  (193.9)  (l  .0323  *')  (s.96IS  *')  (tOl.fo  *') 

(S-.00126M (5+7.7809) (S:+2.3062S+20.6761)  ( 5 A 7--s.  .\  (7_J ? . LLiliU.. 

vtoottkt  V \7.78o9  vrprn)  * rwr 541 


in 
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Table  A— 1 3 (Continued) 


lateral  APV  Transfer  functions  (Continued) 


Transfer 

function 


Standard  form 


.its),  PSl  (II  ,11.2)  (S-K8.9926)  (St*,l.fe686s«-.I997)  (71  .67)  (pf??  *j)  (tUtI  * TCTT^  S*' , 

MS)  OR  (s*.  00 1 22 1 5)  (S+9. 1961)  (S2+2.7372S+26.9275)(S)  Y S W S \l/  s f . 2(.276)r.H 

\00122T5  VsTW  *79927  S*J 

00.351.)  (S+8.6180  (S»+.63378S+.1996)  (70.97)  (s76TBT  *')  **'1  ,, 

(S-. 0012306)  (S+8.6059)  (S:+2.5592S+23.l666)(S)  J S \!  S \ITT~  \J  2 (T2bb),  71 

Koohm  '!)  (.875059  +,J  (omr)  ♦ ram  *♦> 

(9.2571)  (S+7.6118)  (sJ+.3869S+.1995)  (70.26)  (m7TF  *)  (tW  + 7667^  S*'l  II 

(S-. 001266)  ($+7.7809)  (Si+2.3082S+20.676I)  6)  ~ S -\  / S Vf7  " 5"  V ' 7(?56)  ..71 

\oohu  ')  [rrm  *') J0S7557T7  + otrr  s*'| 


i(S)/Sr(S)  - *(S)/6r(S)  -(s)  (PSID0T/0R) 


Transfer 

Function 


Standard  Form 


♦ (S>  PHI  (6. 1927) (S-6, 3056) (S+3. 3882) 
VOT’  0"  (S-.00122 15)  (S+9. 1961 ) (S!+2, 


7372S+26.9275) 


(5.7566) ($-6.1 318) (S+3. 2732) 


(5.16$) ($-3.8809) (S*3. 1051) 

(S-. 001266) ($+7.7809) (S2+2.3082S+20. 6761) 


(322.7)  (6.3056  •’)  *') 

(roo-Wrs  *')  M§2^+  raHr  ^ 

(317.5)(6.ljl8  (3.2732  *0 

GoW  -’)  fe  *')  (0TTiJ+  raTT7s^j 

(309.81(3.8809  ‘'Xrarer*1) 

(.001266  -’)  (777809  +l)  (..W+ ^5t7T>SH 


}(S)/«r(S)  - ♦(S)/«r(S)*  ($)  (PH  I DOT /DR) 


Transfer 

function 


Standard  Form 


B( S)  BETA 

V*V  OR  (.  10575)  (S-.017937)  (S+9. 1 125)  (S+105. 27) 
(S-. 0012215) (S+9. 1 961 )(SJ+2.7372S+26. 9275) 


(.09896) ($-.018039) (S+8,5389) (S+106.56) 
(S-.00I2306) (S+8.6059) ($2+2.5592S+23.1666) 


(.08962) ($-.Ol8l92)IS+7. 7333) (S+103.62) 
(S-. 001266)  (S+7.7809)  (S!+2.3082S+20.67U) 


(6.5)  (.017937  -'XoTK  ^(loOT*1)  | 

(70012215  -’) (5: wt  +1) 

16.5)(.Qi8039  -')  (0389  +1)  (rocnr  ♦')  ,, 

(.-001230?  *')  (to59  *)  OTTT>s*'j 

(_6_.5)  (toW  -'Xmm  *1)(t57trt *0 
(tooW  -')(7^509  *')  * 


i 


L 


* 


THDCJT/DE  PLANT  FREQUENCY  RESPONSE 


L 


PHASE  SH [FT  tOEOREES) 


IfO 


ito 


(0 


0 


FREQUENCY  IRflO/SEC) 

Figure  A*3a«  -a/6^  Frequency  Response 


U/OE  PLRNT  FREQUENCY  RESPONSE 


FREQUENCY  (RAO/SEC) 


PHASE  SHtFT  [DEGREES) 


ft 


Figure  A-4a:  4>/6q  Frequency  Response 


Figure  A-4b:  <)>/6a  * Actuator  Frequency  Response 
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PHASE  SHIFT  (OEOftF.ES) 


PH100T/DR  PLANT  FREQUENCY  RESPONSE 


FREQUENCY  IRfiD/SEC ) 

Figure  A-5a:  4>/6  Frequency  Response 

3 


PH IOOT/DA  a ACTUATOR  FREQUENCY  RESPONSE 
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Figure  A-6b:  ty/6  Frequency  Response 

d 


184 


PHASE  SHIFT 


Figure  A~7:  B/6  Frequency  Response 

d 


U 


PHASE  SHIFT 


186 


! 


PS  I DOT/DR  PLANT  FREQUENCY  RESPONSE 


phi/oh:  plant  frcqucnct  response 


FHRSE  SHIFT  ICEOEEES) 


PHASE  SHIFT  (OEOfiEES) 


Figure  A-12b:  -9/6e  Time  Response  (Phugoid) 

190 


PHl/Ufi  PIRNT  RESPONSE  TO  UNIT  PULSE  (MlOTH=l) 


r"  r 


203 


PH  1 00  T /OR  PLANT  RESPONSE  TO  UNIT  STEP 


Figure  A-26a:  4>/6 r Time  Response  (Step) 


f 


i 


PHIDOT/DR  RESPONSE  TO  UNIT  PULSE  ( W I0TH= . 4 ) 


HUE  I SECONDS  > 

Figure  A-26b:  <|>/6r  Time  Response  (Pulse) 
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BETfi/OK  PLANT  RESPONSE  TO  UNIT  STEP 


Figure  A-27a:  B/6r  Time  Response  (Step) 


205 


4 


«mm 


MMUM 


Figure  A-29b:  0/6  * Actuator  Root  Locus  (Phugoid) 


e 
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BETR/Dfl  PLANT  ROOT  LOCUS 


Figure  A-37:  £/<5a  Root  Locus 
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— PS  I DOT /DR  PLANT  ROOT  LOCUS 


J»>  10 


'Ipp?T{lF 


7.6 

0 (deg/sec)  ® 

-7.6 


“(deg) 


U(ft/sec)  100 


*■  20  sec 


Figure ^A-W:  Free  RPV  Airframe  Response  to  a 2 Degree  Step  Elevator 
Deflection  (Case  II);  Without  Actuator 


e (deg/sec)  0 


U(ft/sec)  100 


Figure  A-^3 


Free  RPV  Airframe  Response  to  a 2 Degree  Step  Elevator 
Deflection  (Case  II);  With  Actuator 


a 5 Deg 
Actuato 


ijf  (deg/sec) 


.lilikllijiL 


J.-Lll: 


Figure  A-l»7:  Free  RPV  Airframe  Response  to  a 5 Degree  Puise  Rudder 
Deflection  (Case  II);  With  Actuator 
225 
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Appendix  B 

Autopilot  Gain  Descriptions 

The  purpose  of  this  appendix  is  to  provide  the  gains  necessary  to 
perform  the  A/P  model  analysis  (chapter  II)  and  digital  A/P  mechaniza- 
tion (chapter  VI).  Basic  analog  A/P  feedback  loop  gains  are  given  in 
(Ref  29)  and  were  determined  by  manual  tuning  of  a hybrid  simulation 
analog  A/P.  Figure  B-1  illustrates  the  general  gain  structure.  This 
can  be  applied  to  any  or  all  the  various  control  loops.  Note  that  all 
gains  are  mechanized  in  the  feedback  loops  only.  The  electrical  gains, 
those  that  can  be  tuned  for  performance  specifications,  are  indicated 
by  Kp  and  K^,  respectively.  These  were  measured  experimentally  in  the 
laboratory  as  a check  of  those  listed  in  (Ref  29). 

Gains  for  Linear  Control  Analysis  (chapter  II) 

The  control  analysis  of  chapter  II  requires  totai  DC  loop  gains. 
These  are  calculated  by  reference  to  Fig.  B-1  as  follows: 

Krl  (Rate  Loop)  = (K^)  (Kr)  (Krs) 

Kal  (Attitude  Loop)  = (Kact)(Ka)(Kvg) 

Table  B-1  provides  a summary  of  these  gains. 

Gains  for  Digital  A/P  Controllers 

The  digital  controllers  require  feedback  gains  for  their  implemen- 
tation in  software.  These  gains  were  measured  electrically,  directly 
from  the  analog  A/P  and  follow  the  basic  structure  of  Fig.  B-2.  Results 
are  also  included  in  table  B-1. 
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Figure  B-1:  Analog  Autopilot  Gain  Structure  (KBG  Corp,)  (Ref  29) 


Digital  Controller 
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Appendix  C 


Schemat i cs 


Elf  II  Schematic 
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Appendix  D 


HP-29C  Programmable  Calculator  Program  to  Examine  Filter 
Characteristics  on  a Step-by-Step  Basis 


Line 

Keycode 

Step 

Comments 

01 

15  13  01 

gLBL  1 

Initialize 

02 

01 

1 

Initialize 

03 

02 

2 

Initialize 

Ok 

08 

8 

Initialize 

05 

23  01 

ST0  1 

Initialize 

06 

23  02 

ST0  2 

Initialize 

07 

23  04 

ST0  4 

Initialize 

08 

23  05 

ST0  5 

Initialize 

09 

74 

R/S 

Stop  and  wait  for  input 

10 

15  13  02 

gLBL  2 

11 

23  00 

ST0  0 

Store  input,  x (k) 

12 

24  06 

RCL  6 

Reca 1 1 A 

13 

61 

X 

X (k)  x X 

11* 

24  01 

RCL  1 

Recall  X (k-1) 

15 

24  07 

RCL  7 

Recall  A. 

16 

61 

X 

X (k-1)  x A, 

17 

51 

+ 

18 

24  02 

RCL  2 

Recall  X (k-2) 

19 

24  08 

RCL  8 

Recall  A£ 

20 

61 

X 

X (k-2)  x A2 

21 

51 

+ 

22 

24  04 

RCL  4 

Recall  Y (k-1) 

23 

24  09 

RCL  9 

Recall  B. 

2k 

61 

X 

Y (k-1)  x Bj 

25 

51 

+ 

26 

24  05 

RCL  5 

Recall  Y (k-2) 

27 

24.0 

RCL  .0 

Recall  B2 

28 

61 

X 

Y (k-2)  x B2 

29 

51 

+ 

30 

06 

6 

*64 

31 

04 

4 

*64 

32 

71 

* 

*64 

33 

23  03 

STO  3 

Store  Y (k) 

3k 

24  04 

RCL  4 

Y (k-1  )-*-Y  (k-2) 

35 

23  05 

STO  5 

Y (k-1  )-*Y  (k-2) 

36 

24  03 

RCL  3 

Y (k)-*-Y  (k-1) 

37 

23  04 

STO  4 

Y ( k)-*-Y  (k-1) 

38 

• 

24  01 

RCL  1 

X (k-D+X  (k-2) 

39 

23  02 

STO  2 

X (k-l)+X  (k-2) 

1*0 

24  00 

RCL  0 

X ( k)-*-X  (k-1) 

1*1 

23  01 

STO  1 

X (k)-X  (k-1) 

42 

24  03 

RCL  3 

Display  Y (k) 

234 


If 

: 

i 


Register  Allocation: 


RO 

- X (k) 

R1 

- X (k-1) 

R2  - X (k-2) 

R3 

- Y (k) 

R4 

- Y (k-1) 

R5  - Y (k-2) 

R6 

' Ao 

R7 

- At 

30 

OO 

1 

> 

ro 

R9 

- B1 

R.O 

“ B2 

To  Use: 

Load  program. 

-—Store  constants  in  R6  through  R.O  (including  sign). 

-—Depress  65B  1 to  initialize. 

— — Enter  input  and  depress  R/S  for  each  iteration.  128  represents 
2.5  volts  (center)  and  256  represents  5 volts  (full  scale). 
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Appendix  E 


Digital  Autopilot  Program  Listing 


0000 

> 

..LISTING  FOR  XBQM-106  DIGITAL  AUTOPILOT 

0000 

» 

..FOR  USE  WITH  CDP1802  MICROPROCESSOR 

0000 

9 

..OCCUPIES  3/4  K BYTES 

0000 

COFOOO 

LBR  00  ..GO  TO  MONITOR 

0003 

F804 

LDI  04  ..POINTER  TO  PAGE  4 FOR  R1-R4,  R6-RA 

0005 

B1 

PHI  1 ..  " 

0006 

B2 

PHI  2 ..  " 

0007 

B3 

PHI  3 ..  " 

0008 

B4 

PHI  4 ..  » 

0009 

b6 

PHI  6 ..  " 

000A 

B7 

PHI  7 ..  " 

000B 

B8 

PHI  8 ..  " 

OOOC 

B9 

PHI  9 ..  " 

• 

OOOD 

BA 

PHI  A ..  " 

► 

» 

000E 

E6 

SEX  6 ..  SET  RX  = 6 

000F 

F8A9 

LDI  A9  ..  A9-H) 

i 

0011 

A6 

PLO  6 . .A9+R6.0  (ADDRESS  OF  TEMP) 

0012 

F801 

LDI  01  ..  01+D 

0014 

56 

STR  6 ..  01->-M  (R6)  (01->M(A9),  01  IS  A/D  MUX  ADDRESS) 

0015 

67 

OUT  7 ..  LATCH  MUX  ADDRESS  01  AND  START  CONVERSION 

0016 

F8B9 

LDI  B9  ..  B9+D 

0018 

A2 

PLO  2 ..  B9-R2.0  (LOCATION  OF  STACK) 

0019 

F8C0 

LDI  CO  ..  CO+D 

f 

001 B 

A1 

PLO  1 ..  C0-*-R1 .0  (LOCATION  OF  INPUT  INTERRUPT  ROUTINE) 

001C 

F8B0 

LDI  BO  ..  BO-*-D 

001 E 

AA 

PLO  A ..  BO-^RA.O  (LOCATION  OF  YAW  RATE  INPUT) 

00  IF 

A3 

PLO  3 ..  B0+R3  (LOCATION  OF  FIRST  INPUT) 

if 

0020 

F8CA 

LDI  CA  ..  CA-+D 

0022 

A9 

PLO  9 -.  CA->-R9.0  (LOCATION  OF  ADD  SUBROUTINE) 

0023 

F8D6 

LDI  D6  ..  D6->-D 

i 

0025 

A8 

PLO  8 ..  D6-*8.0  (LOCATION  OF  SUBTRACT  SUBROUTINE) 

0026 

F8E2 

LDI  E2  ..  E2-K) 

t 

0028 

A7 

PLO  7 ..  E2-*-R7.0  (LOCATION  OF  MULTIPLY  SUBROUTINE) 

0029 

00 

IDL  ..  WAIT  FOR  YAW  RATE  CONVERSION  TO  COMPLETE 

002A 

> 

• • 

! 

002A 

* 

..  INITIALIZATION  OF  2ND  CONVERSION  (YAW  PENDULUM)  FOLLOWS 

002A 

26 

DEC  6 ..  REPOSITION  POINTER  TO  TEMP  (A9) 

i 

002B 

F802 

LDI  02  ..  02+D 

002D 

56 

STR  6 ..  02->M  (R6)  (02-*-M(A9),  02  IS  A/D  MUX  ADDRESS) 

002E 

67 

OUT  7 ..  LATCH  MUX  ADDRESS  02  AND  START  CONVERSION 

l 

002F 

F8AB 

LDI  AB  ..  AB  •>  D 

0031 

AA 

PLO  A ..  AB  -*•  RA.O  (LOCATION  OF  YAW  PENDULUM  INPUT) 

i 

0032 

9 

• • • ,] 

1 

r 

0032 

• • 

9 • 

. . Aq  • X (k)  FOLLOWS 

0032 

F8BB 

LDI  BB  . . BB  -*■  D 

0034 

A4 

PLO  4 ..  BB  -v  R4.0  (POINTER  TO  OPERAND  1) 

0035 

03 

LDN  3 ..  RETRIEVE  X (k)  (YAW  RATE) 

0036 

54 

STR  4 ..  X(k)  -M(R4)  (X(k) -*•  OPERAND  1) 
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LDI  BA  ..  BA  -*■  D 

PLO  3 ..  BA  -*■  R3.0  (POINTER  TO  OPERAND  2) 

LDI  3F  ..  3F  D 

STR  3 ..  3F  -*■  M(R3)  (3F  OPERAND  2) 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 
• • 

..  INITIALIZATION  OF  3RD  CONVERSION  (ROLL  RATE)  FOLLOWS 
SEX  6 ..  RESET  X 

DEC  6 ..  REPOSITION  POINTER  TO  TEMP  (A9) 

LDI  03  ..  03  D 

STR  6 ..  03  -*■  M(R6)(03 -►M(A9),  03  IS  A/D  MUX  ADDRESS) 

OUT  7 ..  LATCH  MUX  ADDRESS  03  AND  START  CONVERSION 
INC  A ..  INCREMENT  INPUT  LOCATION 

..  A2  • X(k-2)  FOLLOWS 
LDI  B2  . . B2  ->  D 

PLO  3 ..  B2  -*■  R3.0  (POINTER  TO  X(k-2)) 

LDI  BD  . . BD  D 

PLO  4 ..  BD  -►  R4.0  (POINTER  TO  OPERAND  1) 

LDN  3 ..  RETRIEVE  X(k-2) 

STR  4 ..  X(k-2)  -*■  M(R4) , (X (k-2)  -*•  OPERAND  1) 

LDI  BC  ..  BC->-  D 

PLO  3 ..  BC  -*•  R3.0  (POINTER  TO  OPERAND  2) 

LDI  3F  ..  3F  D 

STR  3 ..  3F  M(R3)  (3F  OPERAND  2) 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 
• • 

..  SUMMATION  OF  A • X (k)  + A2  • X (k-2)  FOLLOWS 
DEC  3 ..  REPOSITION  OPERAND  POINTER 
SEP  9 ..  GO  TO  ADD  SUBROUTINE 
• • 

..  INITIALIZATION  OF  4TH  CONVERSION  (ROLL  GYRO)  FOLLOWS 
SEX  6 ..  RESET  X 

DEC  6 ..  REPOSITION  POINTER  TO  TEMP  (A9) 

LDI  04  . . 04  -*■  D 

STR  6 ..  04  -v  M(R6) , (04  M(A9),  C4  IS  A/D  MUX  ADDRESS) 


OUT  7 ..  LATCH  MUX  ADDRESS  04  AND  START  CONVERSION 


INC  A 


INCREMENT  INPUT  LOCATION 


..  Bj  • Y(k-1)  FOLLOWS 
LDI  B3  . . B3  -*•  T 

PLO  4 . . B3  R4.0  (POINTER  TO  Y (k-1 ) ) 

LDN  4 ..  RETRIEVE  Y(k-1) 

STR  3 ..  Y (k-1 ) -*■  M(R3) , (Y(k-I)-*-  OPERAND  1) 
LDI  BB  ..  BB  D 

PLO  4 ..  BB  -►  R4.0  (POINTER  TO  OPERAND  2) 


LDI  7E 
STR  4 .. 


M(R4)  (7E  •+  OPERAND  2) 


SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

.!  PREVIOUS  SUMMATION  + B^  • Y(k-l)  FOLLOWS 
INC  3 ..  POSITION  POINTER  TO  OPERAND  1 


4 


006A 

14 

INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

006B 

14 

INC  4 ..  » 

006C 

09 

SEP  9 ..  GO  TO  ADD  SUBROUTINE 

006D 

9 

• • 

006D 

9 

..  INITIALIZATION  OF  5TH  CONVERSION  (PITCH  RATE)  FOLLOWS 

006D 

E6 

SEX  6 ..  RESET  X 

006E 

26 

DEC  6 ..  REPOSITION  POINTER  TO  TEMP  (A9) 

006F 

F8Q5 

LO  l 05  . • 05  -*•  D 

0071 

56 

STR  6 ..  05  + M(R6),  (05  M(A9) , 05  IS  A/D  MUX  ADDRESS) 

0072 

67 

OUT  7 ..  LATCH  MUX  ADDRESS  05  AND  START  CONVERSION 

0073 

1 A 

INC  A ..  INCREMENT  INPUT  LOCATION 

0074 

9 

• • 

0074 

9 

..  B.  • Y(k-1)  FRAC  FOLLOWS 

0074 

F8B5 

LDI  B5  ..  B5  -*■  D 

0076 

A4 

PLO  4 ..  B5  -»•  R4.0  (POINTER  TO  Y(k-l)  FRAC) 

0077 

04 

LDN  4 ..  RETRIEVE  Y(k-1)  FRAC 

0078 

53 

STR  3 ..  Y(k-1)  FRAC-*-  M(R3) , (Y(k-1)  FRAC  -►OPERAND  1) 

r 

0079 

F8BB 

LDI  BB  ..  BB  -*•  D 

007B 

A4 

PLO  4 ..  BB  -*-  R4.0  (POINTER  TO  OPERAND  2) 

007C 

F87E 

LDI  7E  ..  7E  -*•  D 

007E 

54 

STR  4 ..  7E  -*-  M(R4)  (7E  -*-  OPERAND  2) 

007F 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

0080 

• 

9 

• ♦ 

I 

0080 

9 

..  DIVISION  OF  ABOVE  PRODUCT  BY  8 FOLLOWS  (SHIFT  8 PLACES 

0080 

9 

..  RIGHT) 

0080 

03 

LDN  3 ••  RETRIEVE  8 MSB'S  OF  PRODUCT 

r 

0081 

54 

STR  4 ..  PLACE  INTO  8 LSB'S  OF  PRODUCT 

0082 

F800 

LD 1 00  . . 00  -*-  D 

0084 

53 

STR  3 ..  ZERO  INTO  8 MSB'S  OF  PRODUCT 

0085 

9 

• • 

0085 

9 

..  PREVIOUS  SUMMATION  + Bj  . Y(k-l)  FRAC  FOLLOWS 

0085 

13 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 

0086 

14 

INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

} 

0087 

14 

INC  4 ..  " 

? 

0088 

09 

SEP  9 ..  GO  TO  ADD  SUBROUTINE 

f 

* 

0089 

1 

• • 

0089 

9 

..INITIALIZATION  OF  6TH  CONVERSION  (PITCH  GYRO)  FOLLOWS 

0089 

E6 

SEX  6 ..  RESET  X 

008A 

26 

DEC  6 ..  REPOSITION  POINTER  TO  TEMP  (A9) 

008B 

F806 

LDI  06  ..  06  -*•  D 

008D 

56 

STR  6 . . 06  -+■  M(R6) , (06  -*-M(A9),  06  IS  A/D  MUX  ADDRESS) 

f 

008E 

67 

OUT  7 ..  LATCH  MUX  ADDRESS  06  AND  START  CONVERSION 

008F 

1A 

INC  A ..  INCREMENT  INPUT  LOCATION 

0090 

* 

• • 

0090 

9 

..  A,  • X(k-l)  FOLLOWS 

0090 

F8B1 

LDI  B1  ..  B1  -*•  0 

0092 

A4 

PLO  4 ..  B1  -*■  R4.0  (POINTER  TO  X(k-l)) 

0093 

04 

LDN  4 ..  RETRIEVE  X(k-l) 

0094 

53 

STR  3 ..  X(k-1)  M(R3),  (X(k-l)-*-  OPERAND  1) 

0095 

F8BB 

LDI  BB  ..  BB  -*•  D 

0097 

A4 

PLO  4 ..  BB  -*■  R4.0,  (POINTER  TO  OPERAND  2) 
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0098 

F87E 

LDI  7E  ..  7E  D 

009A 

54 

STR  4 ..  7E  ■>  M(R4) , (7E  -+■  OPERAND  2) 

009B 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

009C 

9 

• • 

009C 

9 

..  PREVIOUS  SUMMATION  - A-  • X(k-l)  FOLLOWS 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 

009C 

13 

009D 

14 

INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

009E 

14 

INC  4 ..  » 

009F 

D8 

SEP  8 ..  GO  TO  SUBTRACT  SUBROUTINE 

00A0 

9 

• • 

OOAO 

3BE8 

BNF  E8  ..  GO  TO  OVERFLOW  IF  SUBTRACTION  RESULT 

NEG 

00A2 

> 

• • 

00A2 

» 

..  B,  • Y (k— 2)  FOLLOWS 

LDI  B4  ..  B4  -*•  D 

00A2 

F8B4 

00A4 

A4 

PLO  4 . . B4  -»■  R4.0,  (POINTER  TO  Y (k-2) ) 

00A5 

04 

LDN  4 . . RETRIEVE  Y(k-2) 

00A6 

53 

STR  3 ..  Y (k— 2)  M(R3),  (Y (k-2) -*■  OPERAND  1) 

00A7 

F8BB 

LDI  BB  ..  BB  -+•  D 

00A9 

A4 

PLO  4 ..  BB  -*■  R4.0  (POINTER  TO  OPERAND  2) 

OOAA 

F83E 

LDI  3E  ..  3E  -*•  D 

OOAC 

54 

STR  4 ..  3E  -*■  M(R4),  (3E  -*■  OPERAND  2) 

OOAD 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

OOAE 

9 

• • 

OOAE 

9 

..  PREVIOUS  SUMMATION  - B,  • Y(k-2)  FOLLOWS 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 

OOAE 

13 

OOAF 

14 

INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

OOBO 

14 

INC  4 ..  " 

00B1 

D8 

SEP  8 ..  GO  TO  SUBTRACT  SUBROUTINE 

00B2 

9 

• • 

00B2 

3BE8 

BNF  E8  ..  GO  TO  OVERFLOW  IF  SUBTRACTION  RESULT 

NEG 

00B4 

9 

• • 

oob4 

9 

..  B,  • Y (k-2)  FRAC  FOLLOWS 

LDI  B6  ..  B6  -*•  D 

00BA 

F8B6 

00B6 

A4 

PLO  4 ..  B6  R4.0,  (POINTER  TO  Y (k-2) FRAC) 

00B7 

04 

LDN  4 ..  RETRIEVE  Y(k-2)  FRAC 

00B8 

53 

STR  3 ..  Y (k-2)  FRAC  ♦ M(R3) , (Y(k-2)  FRAC  OPERAND  1) 

00B9 

F8BB 

LDI  BB  ..  BB  -+■  D 

OOBB 

A4 

PLO  4 ..  BB  -*•  R4.0,  (POINTER  TO  OPERAND  2) 

OOBC 

F83B 

LDI  3E  ..  3E  D 

OOBE 

54 

STR  4 ..  3E  -*■  M(R4),  (3E  OPERAND  2) 

OOBF 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

OOCO 

9 

• • 

OOCO 

9 

..  DIVISION  OF  ABOVE  PRODUCT  BY  8 FOLLOWS  (SHIFT  8 PLACES 

OOCO 

9 

..  RIGHT) 

OOCO 

03 

LDN  3 ..  RETRIEVE  8 MSB'S  OF  PRODUCT 

00C1 

54 

STR  4 ..  PLACE  INTO  8 LSB'S  OF  PRODUCT 

00C2 

F$00 

LDI  00  ..  00  -*•  D 

00C4 

53 

STR  3 ..  ZERO  INTO  8 MSB'S  OF  PRODUCT 

00C5 

i 

• • 

00C5 

9 

..  PREVIOUS  SUMMATION  - B,  • Y(k-2)  FRAC  FOLLOWS 

00C5 

13 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 

) 
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00C6 

14 

INC 

4 .. 

POSITION  POINTER  TO  OPERAND  2 

00C7 

14 

INC 

4 .. 

II 

00C8 

D8 

SEP 

8 .. 

GO  TO  SUBTRACT  SUBROUTINE 

00C9 

i 

• • 

00C9 

3BE8 

BNF 

E8  . 

. GO  TO  OVERFLOW  IF  SUBTRACTION  RESULT  NEG 

00CB 

9 

* • 

OOCB 

f 

..  CHECK 

FOR  EXCESSIVE  SUM  (A  ONE  IN  2 MSB'S)  FOLLOWS 

OOCB 

04 

LDN 

4 .. 

RETRIEVE  SUM 

OOCC 

FE 

SHL 

..  SHIFT  LEFT  (MSB  -*-DF) 

OOCD 

33E8 

BOF 

E8  . 

. GO  TO  OVERFLOW  IF  DF=1 

OOCF 

FE 

SHL 

..  SHIFT  LEFT  (MSB-1  -*  DF) 

OODO 

33E8 

BDF 

E8  . 

. GO  TO  OVERFLOW  IF  DF=1 

00D2 

9 

• • 

00D2 

9 

..  REPOSITION  OF  VALUES  OF  NEXT  ITERATION  FOLLOWS 

00D2 

F8B5 

LOI 

B5  . 

. B5  -*•  D 

00D4 

A3 

PLO 

3 .. 

B5  -»■  R3.0  (POINTER  TO  Y(k-l)  FRAC) 

00D5 

43 

LDA 

3 .. 

RETRIEVE  Y(k-1)  FRACT 

0006 

53 

STR 

3 .. 

Y (k-1 ) FRAC-*-  Y(k-2)  FRAC 

00D7 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  Y(k-1) 

00D8 

23 

DEC 

3 .. 

II 

00D9 

23 

DEC 

3 .. 

II 

OODA 

43 

LDA 

3 .. 

RETRIEVE  Y(k-l) 

OOOB 

53 

STR 

3 .. 

Y(k-l)  Y (k-2) 

OODC 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  X(k-1) 

OODD 

23 

DEC 

3 .. 

II 

OODE 

23 

DEC 

3 .. 

II 

OODF 

43 

LDA 

3 .. 

RETRIEVE  X(k-1) 

00  EO 

53 

STR 

3 .. 

X (k-1 ) -*-X(k-2) 

00E1 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  X(k) 

00E2 

23 

DEC 

3 .. 

II 

00E3 

43 

LDA 

3 .. 

RETRIEVE  X(k) 

00E4 

53 

STR 

3 .. 

X (k)  -*■  X (k—  1 ) 

00E5 

COO 100 

LBR 

0100 

..  GO  TO  NEXT  MEMORY  PAGE  (PAGE  01) 

00E8 

9 

• • 

00E8 

9 

..  OVERFLOW  ROUTINE  FOLLOWS 

00E8 

F8B6 

LDI 

B6  . 

. B6  -*-  D 

OOEA 

A3 

PLO 

3 .. 

B6  -*-  R3.0,  (POINTER  TO  Y(k-2)  FRAC) 

OOEB 

F800 

LDI 

00  . 

. 00  -*-  D 

OOED 

53 

STR 

3 .. 

00  ■>  M(R3),  (00  Y (k-2)  FRAC) 

OOEE 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  Y (k-1 ) FRAC 

OOEF 

53 

STR 

3 .. 

00  -*-  Y (k-1 ) FRAC 

OOFO 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  Y(k-2) 

00F1 

F880 

LDI 

80  . 

. 80  D 

00F3 

53 

STR 

3 .. 

80  -*•  M(R3),  (80  ->•  Y (k-2) ) 

00F4 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  Y(k-l) 

00F5 

53 

STR 

3 .. 

80  - Y(k-l) 

00F6 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  X(k-2) 

00F7 

53 

STR 

3 .. 

80  -*•  X(k-2) 

00F8 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  X(k-l) 

00F9 

53 

STR 

3 .. 

80  -►  X(k-l) 

OOFA 

23 

DEC 

3 .. 

REPOSITION  POINTER  TO  X(k) 

OOFB 

E6 

SEX 

6 .. 

RESET  X 

240 


OOFC 

302A 

BR  2A  . 

. GO  TO  002A  (THRU  FILTER  ALGORITHM  AGAIN) 

OOFE 

00 

IDL  .. 

USED  BY  MONITOR 

OOFF 

00 

IDL  .. 

USED  BY  MONITOR 

0100 

9 

• • 

0100 

9 

..  DIVISION  BY  64  (BY  BINARY  POINT  SHIFTING)  FOLLOWS 

0100 

F8BA 

LDI  BA 

..  BA  ■*  D 

0102 

AA 

PLO  A . 

. BA  -*■  RA.O,  (POINTER  TO  UPPER  BYTE  OF  RESULT) 

0103 

F8B5 

LDI  B5 

..  B5  D 

0105 

A3 

PLO  3 . 

. B5  -*■  R3.0  (POINTER  TO  Y(k-l)  FRAC) 

0106 

11* 

INC  4 . 

. POSITION  POINTER  TO  LOWER  BYTE  OF  RESULT 

0107 

01* 

LDN  4 . 

. RETRIEVE  LOWER  BYTE 

0108 

FE 

SHL  .. 

SHIFT  LEFT 

0109 

51* 

STR  4 . 

. REPLACE  LOWER  BYTE 

01 OA 

21* 

DEC  4 . 

. POSITION  POINTER  TO  UPPER  BYTE 

010B 

01* 

LDN  4 . 

. RETRIEVE  UPPER  BYTE 

010C 

7E 

SHLC  .. 

SHIFT  LEFT  WITH  CARRY- IN 

010D 

54 

STR  4 . 

. REPLACE  UPPER  BYTE 

010E 

14 

INC  4 . 

. POSITION  POINTER  TO  LOWER  BYTE 

010F 

04 

LDN  4 . 

. RETRIEVE  LOWER  BYTE 

0110 

FE 

SHLC  .. 

SHIFT  LEFT 

0111 

53 

STR  3 . 

. LOWER  BYTE  -*■  Y(k-l)  FRAC 

0112 

23 

DEC  3 . 

. POSITION  POINTER  TO  Y(k-l) 

0113 

23 

DEC  3 . 

II 

• 

0111* 

24 

DEC  4 . 

. POSITION  POINTER  TO  UPPER  BYTE 

0115 

04 

LDN  4 . 

. RETRIEVE  UPPER  BYTE 

0116 

7E 

SHLC  .. 

SHIFT  LEFT  WITH  CARRY- IN 

0117 

53 

STR  3 . 

. UPPER  BYTE  -*■  Y (k-1) 

0118 

5A 

STR  A . 

. UPPER  BYTE  -*■  OPERAND  1 

0119 

9 

• • 

0119 

9 

..YAW  AXIS  COMPUTATIONS  FOLLOW 

0119 

9 

• • 

0119 

9 

..FILTERED  YAW  RATE  X GAIN  FOLLOWS 

0119 

F8BA 

LDI  BA 

. . BA  D 

01 1 B 

A3 

PLO  3 . 

. BA-*-  R3.0,  (POINTER  TO  OPERAND  1) 

one 

F8BB 

LDI  BB 

. . BB  ^ D 

01 1 E 

A4 

PLO  4 . 

. BB  -*-  R4.0,  (POINTER  TO  OPERAND  2) 

01  IF 

F875 

LDI  75 

..  75  -►  D 

0121 

54 

STR  4 . 

. 75  -*-  M(R4),  (GAIN  VALUE  75  -►  OPERAND  2) 

0122 

D7 

SEP  7 . 

. GO  TO  MULTIPLY  SUBROUTINE 

0123 

9 

• • 

0123 

9 

..YAW  PENDULUM  X GAIN  FOLLOWS 

0123 

F8AB 

LDI  AB 

. . AB  -*-  D 

0125 

AA 

PLO  A . 

. AB  -*■  RA.O,  (POINTER  TO  YAW  PENDULUM  INPUT) 

0126 

13 

INC  3 . 

. POSITION  POINTER  TO  OPERAND  1 

0127 

13 

INC  3 . 

II 

• 

0128 

4A 

LDA  A . 

. RETRIEVE  YAW  PENDULUM  INPUT 

0129 

53 

STR  3 . 

. YAW  PENDULUM  INPUT-*-  OPERAND  1 

01 2A 

14 

INC  4 . 

. POSITION  POINTER  TO  OPERAND  2 

012B 

14 

INC  4 . 

it 

• 

012C 

F817 

LDI  17 

..  17  * D 

012E 

54 

STR  4 . 

. 17  -*-  M(R4) , (GAIN  VALUE  17  -►OPERAND  2) 

21*1 


L — ..  : . - 1 


IT 


01 2F 

07 

SEP  7 .. 

GO  TO  MULTIPLY  SUBROUTINE 

0130 

9 

• • 

0130 

9 

..  SUMMATION  OF  INNER  AND  OUTER  LOOPS  FOLLOWS 

0130 

23 

DEC  3 .. 

POSITION  POINTER  TO  OPERAND  1 

0131 

D9 

SEP  9 .. 

GO  TO  ADD  SUBROUTINE 

0132 

9 

• • 

0132 

9 

..  SAVING  OF  SUM  IN  TEMP  (A9-AA)  FOLLOWS 

0132 

F8A9 

LDI  A9  . 

. A9  D 

0134 

A3 

PLO  3 .. 

A9  -*•  R3.0,  (POINTER  TO  TEMP  UPPER  BYTE) 

0135 

44 

LDA  4 .. 

RETRIEVE  UPPER  BYTE 

0136 

53 

STR  3 .. 

UPPER  BYTE  -»■  TEMP  (A9) 

0137 

13 

INC  3 .. 

POSITION  POINTER  TO  TEMP  LOWER  BYTE  (AA) 

0138 

04 

LON  4 .. 

RETRIEVE  LOWER  BYTE 

0139 

53 

STR  3 .. 

LOWER  BYTE  -►  TEMP  (AA) 

01 3A 

i 

• • 

01 3A 

9 

..  SUM  - 

MAX  SUM  (65FF)  FOLLOWS 

01 3A 

F8BA 

LDI  BA  . 

. BA  -*■  D 

013C 

A3 

PLO  3 .. 

BA  -*  R3.0  (POINTER  TO  OPERAND  1 UPPER  BYTE) 

01 3D 

F865 

LDI  65  . 

. 65  -*■  D 

013F 

53 

STR  3 .. 

65  -*•  M(R3),  (65  -►  OPERAND  1 UPPER  BYTE) 

0140 

13 

INC  3 .. 

POSITION  TO  OPERAND  1 LOWER  BYTE 

0141 

F8FF 

LDI  FF  . 

. FF  -*•  D 

0143 

53 

STR  3 .. 

FF  -*•  M(R3),  (FF  -*•  OPERAND  1 LOWER  BYTE) 

0144 

08 

SEP  8 .. 

GO  TO  SUBTRACT  SUBROUTINE 

0145 

9 

• * 

0145 

9 

..CHECK 

FOR  EXCESSIVE  SUM  FOLLOWS 

01 45 

336F 

BDF  6F  . 

. TO  MAX  IF  SUBTRACTION  RESULT  POS 

0147 

• 

9 

• • 

0147 

9 

..RECALL 

OF  SUM  FOLLOWS 

0147 

F8A9 

LDI  A9  . 

. A9  + D 

0149 

A3 

PLO  3 .. 

A9  -*■  R3.0  (POINTER  TO  TEMP  UPPER  BYTE) 

01 4A 

43 

LDA  3 .. 

RETRIEVE  TEMP  UPPER  BYTE 

014b 

54 

STR  4 .. 

UPPER  BYTE  OPERAND  1 

014C 

14 

INC  4 .. 

POSITION  POINTER  TO  OPERAND  2 

014D 

03 

LDN  3 .. 

RETRIEVE  TEMP  LOWER  BYTE 

0l4E 

54 

STR  4 .. 

LOWER  BYTE  -*•  OPERAND  2 

014F 

9 

• • 

014F 

9 

..SUM  - 

MIN  SUM  (2600)  FOLLOWS 

014F 

F8BA 

LDI  BA  . 

. BA  -*■  D 

0151 

A3 

PLO  3 .. 

BA  -*•  R3.0  (POINTER  TO  OPERAND  1) 

0152 

F826 

LDI  26  . 

. 26  D 

0154 

53 

STR  3 .. 

26  M(R3)  (26  -»■  OPERAND  2 UPPER  BYTE) 

0155 

13 

INC  3 .. 

POINTER  TO  OPERAND  2 LOWER  BYTE 

0156 

F800 

LDI  00  . 

. 00  -*■  D 

0158 

53 

STR  3 .. 

00  M(R3)  (00  -*■  OPERAND  2 LOWER  BYTE) 

0059 

08 

SEP  8 .. 

GO  TO  SUBTRACT  SUBROUTINE 

015A 

• • 

9 * 

«»  • 

015A 

• 

9 

..  CHECK  FOR  TOO  SMALL  A SUM  FOLLOWS 

015A 

3B77 

BNF  77  . 

. TO  MIN  IF  SUBTRACTION  NEG 

015C 

9 

• • 

015C 

9 

..  DIVISION  OF  SUM  BY  64  (BY  BINARY  POINT  SHIFTING) 
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015c 

14 

INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

015D 

04 

LDN  4 ..  RETRIEVE  LOWER  BYTE 

01 5E 

FE 

SHL  ..  SHIFT  LEFT 

015F 

54 

STR  4 ..  REPLACE  LOWER  BYTE 

0160 

24 

DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 

0161 

04 

LDN  4 ..  RETRIEVE  UPPER  BYTE 

0162 

7E 

SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

0163 

54 

STR  4 ..  REPLACE  UPPER  BYTE 

0164 

14 

INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

0165 

04 

LDN  4 ..  RETRIEVE  LOWER  BYTE 

0166 

FE 

SHL  ..  SHIFT  LEFT 

0167 

24 

DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 

0168 

04 

LDN  4 ..  RETRIEVE  UPPER  BYTE 

0169 

7E 

SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

01 6A 

> 

• • 

01 6A 

FDFF 

SDI  FF  ..  INVERT  (NEGATIVE  FEEDBACK) 

0l6C 

9 

• • 

01 6C 

54 

STR  4 ..  PUT  RESULT  IN  LOCATION  BC  FOR  OUTPUT 

01 6D 

307D 

BR  7D  ..  TO  OUT 

01 6F 

9 

• • 

01 6F 

9 

..  MAX  FOLLOWS 

016F 

F8BC 

LDI  BC  ..  BC  ♦ D 

0171 

A4 

PLO  4 ..  BC  R4.0  (POINTER  TO  OUTPUT  DATA) 

0172 

F800 

LDI  00  ..  00  D (00  SINCE  INVERSION  NEEDED) 

0174 

54 

STR  4 . . 00  -*■  OUTPUT  DATA 

0175 

307D 

BR  7D  ..  TO  OUT 

0177 

9 

• • 

0177 

9 

..MIN  FOLLOWS 

0177 

F8BC 

LDI  BC  ..  BC  ♦ D 

0179 

A4 

PLO  4 ..  BC  -*■  R4.0  (POINTER  TO  OUTPUT  DATA) 

017A 

F8FF 

LDI  FF  ..  FF  ♦ D (FF  SINCE  INVERSION  NEEDED) 

017C 

54 

STR  4 ..  FF  ■+■  OUTPUT  DATA 

01 7D 

I 

• • 

017D 

9 

..  OUT  FOLLOWS 

017D 

E4 

SEX  4 ..  RESET  X 

017E 

63 

OUT  3 ..  OUTPUT  YAW  COMMAND 

017F 

9 

• • 

01 7F 

9 

..  ROLL  AXIS  FOLLOWS 

017F 

9 

• • 

01 7F 

9 

..  ROLL  RATE  X GAIN  FOLLOWS 

017F 

F8BA 

LDI  BA  . . BA  -f  D 

0181 

A3 

PLO  3 ..  BA  -*•  R3.0  (POINTER  TO  OPERAND  1) 

0182 

4A 

LDA  A ..  RETRIEVE  ROLL  RATE 

0183 

53 

STR  3 ..  ROLL  RATE  -*•  OPERAND  1 

0184 

F8BB 

LDI  BB  ..  BB  -*■  D 

0186 

A4 

PLO  4 ..  BB  -*■  R4.0  (POINTER  TO  OPERAND  2) 

0187 

F81D 

LDI  ID  ..  ID  -*•  D 

0189 

54 

STR  4 ..  ID  -*■  M(R4)  (GAIN  VALUE  ID  •♦OPERAND  2) 

018A 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

01 8B 

9 

• • 

243 
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I 

I 

If 


018B 

) 

..  ROLL 

GYRO  X GAIN  FOLLOWS 

018B 

13 

INC  3 .. 

POSITION  POINTER  TO  OPERAND  1 

0 1 8C 

13 

INC  3 .. 

n 

018D 

4A 

LOA  A .. 

RETRIEVE  ROLL  GYRO  INPUT 

0 1 8e 

53 

STR  3 .. 

ROLL  GYRO  INPUT  -*■  OPERAND  1 

018F 

14 

INC  4 .. 

POSITION  POINTER  TO  OPERAND  2 

0190 

14 

INC  4 .. 

n 

0191 

F866 

LDI  66  . 

. 66  D 

0193 

54 

STR  4 .. 

66  ■+■  M(R4) , (GAIN  VALUE  66  OPERAND  2) 

0194 

D7 

SEP  7 .. 

GO  TO  MULTIPLY  SUBROUTINE 

0195 

i 

• • 

0195 

I 

..  SUMMATION  OF  INNER  AND  OUTER  LOOPS  FOLLOWS 

0195 

23 

DEC  3 .. 

POSITION  POINTER  TO  OPERAND  1 

0196 

D9 

SEP  9 .. 

GO  TO  ADD  SUBROUTINE 

0197 

> 

• • 

0197 

9 

..  SAVING  OF  SUM  IN  TEMP  (A9~AA)  FOLLOWS 

0197 

F8A9 

LDI  A9  . 

. A9  ->  D 

0199 

A3 

PLO  3 .. 

A9  -*■  R3.0  (POINTER  TO  TEMP  UPPER  BYTE) 

01 9A 

44 

LDA  4 .. 

RETRIEVE  UPPER  BYTE 

019B 

53 

STR  3 .. 

UPPER  BYTE  -*■  TEMP  (A9) 

019C 

13 

INC  3 .. 

POSITION  POINTER  TO  TEMP  LOWER  BYTE  (AA) 

019D 

04 

LDN  4 .. 

RETRIEVE  LOWER  BYTE 

019E 

53 

STR  3 .. 

LOWER  BYTE  -*■  TEMP  (AA) 

019F 

» 

• • 

019F 

» 

..  SUM  - 

MAX  SUM  (61 7F)  FOLLOWS 

019F 

F8BA 

LDI  BA  . 

. BA  D 

01A1 

A3 

PLO  3 .. 

BA  -►  R3.0  (POINTER  TO  OPERAND  1 UPPER  BYTE) 

01 A2 

F861 

LDI  61  . 

. 61  -*■  D 

01A4 

53 

STR  3 .. 

61  -*•  M(R3)  (61  -*■  OPERAND  1 UPPER  BYTE) 

01A5 

13 

INC  3 .. 

POSITION  POINTER  TO  OPERAND  1 LOWER  BYTE 

01A6 

F87F 

LDI  7F  . 

. 7F  -#■  D 

01A8 

53 

STR  3 .. 

7F  -*■  M(R3),  (7F  OPERAND  1 LOWER  BYTE) 

01A9 

D8 

SEP  8 .. 

GO  TO  SUBTRACT  SUBROUTINE 

01 AA 

9 

• • 

01 AA 

9 

..  CHECK 

FOR  EXCESSIVE  SUM  FOLLOWS 

01  AA 

33D4 

BDF  D4  . 

. TO  MAX  IF  SUBTRACTION  RESULT  POS 

01  AC 

9 

• • 

01  AC 

9 

..  RECALL  OF  SUM  FOLLOWS 

01  AC 

F8A9 

LDI  A9  . 

. A9  -*■  D 

01 AE 

A3 

PLO  3 .. 

A9  R3.0  (POINTER  TO  TEMP  UPPER  BYTE) 

01 AF 

43 

LDA  3 .. 

RETRIEVE  TEMP  UPPER  BYTE 

01  BO 

54 

STR  4 .. 

UPPER  BYTE  -*■  OPERAND  1 

0 1 B 1 

14 

INC  4 .. 

POSITION  POINTER  TO  OPERAND  2 

01B2 

03 

LDN  3 .. 

RETRIEVE  TEMP  LOWER  BYTE 

01 B3 

54 

STR  4 .. 

LOWER  BYTE  -*■  OPERAND  2 

01 B4 

9 

• • 

01 B4 

• • 

9 • 

..  SUM  - 

MIN  SUM  (21 80)  FOLLOWS 

01 B4 

F8BA 

LDI  BA  . 

. BA  -*•  D 

01 B6 

A3 

PLO  3 .. 

BA  -►  R3.0  (POINTER  TO  OPERAND  1) 

01B7 

F821 

LDI  21  . 

. 21  -*•  D 
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STR  3 ..  21  -*•  M(R3)  (21  -*•  OPERAND  2 UPPER  BYTE) 

INC  3 ..  POINTER  TO  OPERAND  2 LOWER  BYTE 
LDI  80  ..  80  ■*  D 

STR  3 ..  80  -*•  M(R3),  (80  -*•  OPERAND  2 LOWER  BYTE) 

SEP  8 ..  GO  TO  SUBTRACT  SUBROUTINE 

..  CHECK  FOR  TOO  SMALL  A SUM  FOLLOWS 
BNF  DC  ..  TO  MIN  IF  SUBTRACTION  NEG 

..  DIVISION  OF  SUM  BY  64  (BY  BINARY  POINT  SHIFTING) 
..FOLLOWS 

INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

LDN  4 ..  RETRIEVE  LOWER  BYTE 

SHL  ..  SHIFT  LEFT 

STR  4 ..  REPLACE  LOWER  BYTE 

DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 

LDN  4 ..  RETRIEVE  UPPER  BYTE 

SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

STR  4 ..  REPLACE  UPPER  BYTE 

INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

LDN  4 ..  RETRIEVE  LOWER  BYTE 

SHL  ..  SHIFT  LEFT 

DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 
LDN  4 ..  RETRIEVE  UPPER  BYTE 
SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

SDI  FF  ..  INVERT  (NEGATIVE  FEEDBACK) 

STR  4 ..  PUT  RESULT  IN  LOCATION  BC  FOR  OUTPUT 
BR  E2  ..  TO  OUT 

..  MAX  FOLLOWS 
LDI  BC  ..  BC  -*•  D 

PLO  4 ..  BC  -*■  R4.0  (POINTER  TO  OUTPUT  DATA) 

LDI  00  ..  00  -*>  D (00  SINCE  INVERSION  NEEDED) 

STR  4 ..  00  -^OUTPUT  DATA 
BR  E2  ..  TO  OUT 


MIN  FOLLOWS 


LDI  BC 
PLO  4 . 
LDI  FF 
STR  4 . 


R4.0  (POINTER  TO  OUTPUT  DATA) 

D (FF  SINCE  INVERSION  NEEDED) 
OUTPUT  DATA 


..  OUT  FOLLOWS 

SEX  4 ..  RESET  X 

OUT  5 ..  OUTPUT  ROLL  COMMAND 

*..  PITCH  AXIS  FOLLOWS 


01 E4 

• 

9 

..  PITCH  RATE  X GAIN  FOLLOWS 

01 E4 

F8BA 

LDI  BA  ..  BA  -►  D 

01E6 

A3 

PLO  3 ..  BA  -►  R3.0  (POINTER  TO  OPERAND  1) 

0 1 E7 

4A 

LDA  A ..  RETRIEVE  PITCH  RATE 

01E8 

53 

STR  3 ..  PITCH  RATE  -*•  OPERAND  1 

01 E9 

f8bb 

LDI  BB  ..  BB  -*•  D 

01 EB 

A4 

PLO  4 ..  BB  -*■  R4.0  (POINTER  TO  OPERAND  2) 

01  EC 

F81C 

LDI  1C  ..  1C  ■»  D 

01  EE 

54 

STR  4 ..  1C  -*■  M(R4)  (GAIN  VALUE  1C  OPERAND  2) 

01 EF 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

01 F0 

C00400 

LBR  0400  ..  GO  TO  NEXT  PAGE  (PAGE  04) 

01F3 

J, 

00 

II 

IDL  ..  UNUSED 

II  II 

T 

01 FD 

II 

• • 

II  II 

• • 

01FE 

00 

IDL  ..  USED  BY  MONITOR 

\ 

01 FF 

00 

IDL  ..  USED  BY  MONITOR 

► 

r- 

o4oo 

9 

• • 

l 

0400 

9 

..PITCH  GYRO  X GAIN  FOLLOWS 

0400 

13 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 

0401 

13 

INC  3 ..  " 

0402 

OA 

LDN  A ..  RETRIEVE  PITCH  GYRO  INPUT 

i 

0403 

53 

STR  3 ..  PITCH  GYRO  INPUT  •+■  OPERAND  1 

0404 

14 

INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

i 

0405 

14 

INC  4 ..  " 

r 

0406 

F8A3 

LD 1 A3  . . A3  -*•  D 

1 

0408 

54 

STR  4 ..  A3  -►  M(R4)  (GAIN  VALUE  A3 -►OPERAND  2) 

if 

0409 

D7 

SEP  7 ..  GO  TO  MULTIPLY  SUBROUTINE 

| 

040A 

» 

• • 

$ 

04  OA 

» 

..  SUMMATION  OF  INNER  AND  OUTER  LOOPS  FOLLOWS 

: 

040A 

23 

DEC  3 ..  POSITION  POINTER  TO  OPERAND  1 

t 

; 

040B 

09 

SEP  9 ..  GO  TO  ADD  SUBROUTINE 

1 

040C 

9 

• • 

\ 

040C 

9 

..  SAVE  OF  SUM  IN  TEMP  (A9-AA)  FOLLOWS 

1 

040C 

F8A9 

LDI  A9  ..  A9  * D 

* 

040E 

A3 

PLO  3 ..  A9  R3.0  (POINTER  TO  TEMP  UPPER  BYTE) 

i 

040F 

44 

LDA  4 ..  RETRIEVE  UPPER  BYTE 

0410 

53 

STR  3 ..  UPPER  BYTE  ■*>  TEMP  (A9) 

’ 

i 

0411 

13 

INC  3 ..  POSITION  POINTER  TO  TEMP  LOWER  BYTE  (AA) 

0412 

04 

LDN  4 ..  RETRIEVE  LOWER  BYTE 

' 

0413 

53 

STR  3 ••  LOWER  BYTE  ♦ TEMP  (AA) 

* 

0414 

• 

9 

• • 

* 

i 

0414 

9 

..  SUM  - MAX  SUM  (7F7F)  FOLLOWS 

i 

0414 

F8BA 

LDI  BA  ..  BA  -*•  D 

0416 

A3 

PLO  3 ..  BA  -*•  R3.0  (POINTER  TO  OPERAND  1 UPPER  BYTE) 

0417 

F87F 

LDI  7F  ..  7F  -*■  D 

! 

0419 

53 

STR  3 ..  7F  -*>  M(R3)  (7F  -*■  OPERAND  1 UPPER  BYTE) 

\ 

04 1 A 

13 

INC  3 ..  POSITION  POINTER  TO  OPERAND  1 LOWER  BYTE 

| 

041 B 

F87F 

LDI  7F  ..  7F  -*■  D 

041 D 

53 

STR  3 ..  7F  ♦ M(R3)  (7F  ♦ OPERAND  1 LOWER  BYTE) 
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SEP  8 ..  GO  TO  SUBTRACT  SUBROUTINE 


041 E 08 

041F  ; 

041 F ; ..  CHECK  FOR  EXCESSIVE  SUM  FOLLOWS 

041 F 3349  BDF  49  ..  TO  MAX  IF  SUBTRACTION  RESULT  POS 

0421  ; 

0421  ; ..  RECALL  OF  SUM  FOLLOWS 

0421  F8A9  LDI  A9  ..  A9  ■+■  D 

0423  A3  PLO  3 ..  A9  -*-  R3.0  (POINTER  TO  TEMP  UPPER  BYTE) 

0424  43  LDA  3 ..  RETRIEVE  TEMP  UPPER  BYTE 

0425  54  STR  4 ..  UPPER  BYTE  OPERAND  1 

0426  14  INC  4 ..  POSITION  POINTER  TO  OPERAND  2 

0427  03  LDN  3 ..  RETRIEVE  TEMP  LOWER  BYTE 

0428  54  STR  4 ..  LOWER  BYTE  -*■  OPERAND  2 

0429  ; . . 

0429  ; !.  SUM  - MIN  SUM  (3F80)  FOLLOWS 

0429  F8BA  LDI  BA  ..  BA  -*-  D 

042B  A3  PLO  3 ..  BA-*-  R3.0  (POINTER  TO  OPERAND  1) 

042C  F83F  LDI  3F  ..  3F  •*■  D 

042 E 53  STR  3 ..  3F  M(R3)  (3F  -*•  OPERAND  2 UPPER  BYTE) 

042F  13  INC  3 ..  POINTER  TO  OPERAND  2 LOWER  BYTE 

0430  F880  LDI  80  ..  80  -*■  D 

0432  53  STR  3 ..  80  -*■  M(R3)  (80  -*-  OPERAND  2 LOWER  BYTE) 

0433  D8  SEP  8 ..  GO  TO  SUBTRACT  SUBROUTINE 

0434  • . . 

0434  ; !.  CHECK  FOR  TOO  SMALL  A SUM  FOLLOWS 

0434  3B51  BNF  51  ..  TO  MIN  IF  SUBTRACTION  NEG 

0436  ; 

0436  ; ..  DIVISION  OF  SUM  BY  64  (BY  BINARY  POINT  SHIFTING) 

0436  ; ..  FOLLOWS 

0436  14  INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

0437  04  LDN  4 ..  RETRIEVE  LOWER  BYTE 

0438  FE  SHL  ..  SHIFT  LEFT 

0439  54  STR  4 ..  REPLACE  LOWER  BYTE 

043A  24  DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 

043B  04  LDN  4 ..  RETRIEVE  UPPER  BYTE 

043C  7E  SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

043D  54  STR  4 ..  REPLACE  UPPER  BYTE 

043E  14  INC  4 ..  POSITION  POINTER  TO  LOWER  BYTE 

043F  04  LDN  4 ..  RETRIEVE  LOWER  BYTE 

0440  FE  SHL  ..  SHIFT  LEFT 

0441  24  DEC  4 ..  POSITION  POINTER  TO  UPPER  BYTE 

0442  04  LDN  4 ..  RETRIEVE  UPPER  BYTE 

0443  7E  SHLC  ..  SHIFT  LEFT  WITH  CARRY- IN 

^ 

0444  FDFF  SDI  FF  ..  INVERT  (NEGATIVE  FEEDBACK) 

0446  ; 

0446  54  STR  4 ..  PUT  RESULT  TO  LOCATION  BC  FOR  OUTPUT 

0447  3057  BR  57  ..  TO  OUT 

0449  • • • 

0449  ; MAX  FOLLOWS 


E4 

66 

365D 

3059 

C0000D 

00 


LDI  BC  ..  BC  -*■  D 

PLO  4 ..  BC  -*•  R4.0  (POINTER  TO  OUTPUT  DATA) 
LDI  00  ..  00  -*•  D (00  SINCE  INVERSION  NEEDED) 
STR  4 . . 00  -*•  OUTPUT  DATA 
BR  57  ..  TO  OUT 

..MIN  FOLLOWS 
LDI  BC  ..  BC  D 

PLO  4 ..  BC  R4.0  (POINTER  TO  OUTPUT  DATA) 
LDI  FF  ..  FF  D (FF  SINCE  INVERSION  NEEDED) 
STR  4 . . FF  -*■  OUTPUT  DATA 


OUT  FOLLOWS 


SEX  4 ..  RESET  X 

OUT  6 ..  OUTPUT  PITCH  COMMAND 

B3  5D  ..  HAS  "T"  TIMER  EXPIRED 

BR  59  ..  IF  NOT  TEST  AGAIN 

LBR  OOOE  ..  BRANCH  TO  BEGINNING  OF  LOOP 

IDL  ..  UNUSED 


IDL  ..  TEMPORARY  STORAGE 
IDL  ..  TEMPORARY  STORAGE 
IDL  ..  STORAGE  FOR  YAW  PENDULUM  INPUT 
IDL  ..  STORAGE  FOR  ROLL  RATE  INPUT 
IDL  ..  STORAGE  FOR  ROLL  GYRO  INPUT 
IDL  ..  STORAGE  FOR  PITCH  RATE  INPUT 

IDL  ..  STORAGE  FOR  PITCH  GYRO  INPUT 

IDL  ..  STORAGE  FOR  X(k) 

IDL  ..  STORAGE  FOR  X(k-l) 

IDL  ..  STORAGE  FOR  X(k-2) 

IDL  ..  STORAGE  FOR  Y(k-1) 

IDL  ..  STORAGE  FOR  Y(k-2 

IDL  ..  STORAGE  FOR  Y(k-1)  FRAC 

IDL  ..  STORAGE  FOR  Y(k-2)  FRAC 

IDL  ..  STACK 

IDL  ..  STACK 

IDL  ..  STACK 

IDL  ..  USED  FOR  ARITHMETIC  OPERANDS 
IDL  ..  USED  FOR  ARITHMETIC  OPERANDS 
IDL  ..  USED  FOR  ARITHMETIC  OPERANDS 
IDL  ..  USED  FOR  ARITHMETIC  OPERANDS 

..  INTERRUPT  ROUTINE  FOR  DATA  INPUT  FOLLOWS. (EXECUTION 
..  STARTS  AT  04C0) 

LDA  2 ..  RESTORE  ACCUMULATOR 

RET  ..  RESTORE  X AND  P AND  RETURN  TO  MAIN  PROGRAM 

DEC  2 ..  DECREMENT  STACK  POINTER 
SAV  ..  SAVE  STATUS  OF  X AND  P 
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DEC  2 ..  DECREMENT  STACK  POINTER 

STR  2 ..  SAVE  ACCUMULATOR 

SEX  A ..  RESET  X 

INP  3 ..  INPUT  DATA 

SEX  2 ..  RESET  X 

BR  BE  ..  BRANCH  SO  PROGRAM  COUNTER  LEFT  AT  BEGINNING 
• • 

..  ADD  SUBROUTINE  FOLLOWS  (EXECUTION  STARTS  AT  04CA) 

SEP  0 ..  RETURN  TO  MAIN  PROGRAM 
• • 

SEX  4 ..  RESET  X 

LDN  3 ..  RETRIEVE  OPERAND  1 LOWER  BYTE 

ADD  ..  ADD  LOWER  BYTES 

STR  1*  ..  REPLACE  LOWER  BYTE  SUM 

DEC  4 ..  POSITION  POINTER  TO  OPERAND  2 UPPER  BYTE 

DEC  3 ..  POSITION  POINTER  TO  OPERAND  1 UPPER  BYTE 

LDN  3 ..  RETRIEVE  OPERAND  1 UPPER  BYTE 

ADC  ..  ADD  UPPER  BYTES  PLUS  CARRY 

STR  4 ..  REPLACE  UPPER  BYTE  SUM 

BR  C9  BRANCH  SO  PROGRAM  COUNTER  LEFT  AT  BEGINNING 
• • 

..  SUBTRACT  SUBROUTINE  FOLLOWS  (EXECUTION  STARTS  AT  04D6) 
SEP  0 ..  RETURN  TO  MAIN  PROGRAM 
SEX  4 ..  RESET  X 

LDN  3 ..  RETRIEVE  OPERAND  1 LOWER  BYTE 

SD  ..  SUBTRACT  LOWER  BYTES 

STR  4 ..  REPLACE  LOWER  BYTE  RESULT 

DEC  4 ..  POSITION  POINTER  TO  OPERAND  2 UPPER  BYTE 

DEC  3 ..  POSITION  POINTER  TO  OPERAND  1 UPPER  BYTE 

LDN  3 ..  RETRIEVE  OPERAND  1 UPPER  BYTE 

SDB I ..  SUBTRACT  UPPER  BYTES  INCLUDING  BORROW 

STR  4 ..  REPLACE  UPPER  BYTE  RESULT 

BR  D5  ..  BRANCH  SO  PROGRAM  COUNTER  LEFT  AT  BEGINNING 

• • 

..  MULTIPLY  SUBROUTINE  FOLLOWS  (EXECUTION  STARTS  AT  04E2) 
SEP  0 ..  RETURN  TO  MAIN  PROGRAM 

SEX  3 ..  RESET  X 
LD I 08  . . 08  -*•  D 

PLO  6 ..  08-*-  R6.0,  INITIALIZE  LOOP  COUNTER 
LDI  00  . . 00  -+■  D 

PHI  5 ..  00  -*•  R5.I,  INITIALIZE  ACCUM  PROD 

LDN  4 ..  RETRIEVE  MULTIPLIER 

SHR  ..  SHIFT  MULTIPLIER  RIGHT 

BNF  FO  ..  BRANCH  IF  LSB  WAS  NOT  A ONE 

GHI  5 ..  RETRIEVE  ACCUM  PROD 

ADD  ..  ADD  MULTIPLICAND  AND  ACCUM  PROD 

SKP  ..  SKIP  NEXT  INSTRUCTION 

GHI  5 ..  RETRIEVE  ACCUM  PROD 

SHRC  ..  SHIFT  ACCUM  PROD  RIGHT 


04F2 

B5 

PHI  5 

04F3 

04 

LDN  4 

04F4 

76 

SHRC  . 

04F5 

54 

STR  4 

04F5 

9 

..  BYT 

04F6 

26 

DEC  6 

04F7 

86 

GLO  6 

04F8 

3AE9 

BNZ  E9 

04FA 

95 

GHI  5 

04FB 

53 

STR  3 

04FC 

30E1 

BR  El 

04FE 

00 

IDL  .. 

04FF 

00 

IDL  .. 

..  REPLACE  SHIFTED  ACCUM  PROD 

..  RETRIEVE  MULTIPLIER 

. SHIFT  MULTIPLIER  RIGHT  (WITH  CARRY) 

..  REPLACE  SHIFTED  MULTIPLIER  (BECOMES  LOWER 
E RESULT  THE  LAST  TIME  THRU) 

..  DECREMENT  LOOP  COUNTER 
..  RETRIEVE  LOOP  COUNTER 
..  THRU  LOOP  AGAIN  IF  LOOP  COUNTER  NOT  ZERO 
..  RETRIEVE  ACCUM  PROD 
. . ACCUM  PROD  BECOMES  UPPER  BYTE  RESULT 
..  BRANCH  SO  PROGRAM  COUNTER  LEFT  AT  BEGINNING 
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